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component, the number of nodes that can be legally moved to 1s limited, in effect pruning 
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the Tendril search to a specified search depth then applies a heuristic to determine the best 
path to expand upon. 


ill 


TABLE OF CONTENTS 
T. INTRODUCTION... «...<.ccsccoscsocccccssecoacaseccecne secs eeamettetessascescecnasceseiss <ossceceneeseestT tite sat eaaaan—nnn l 
A. OBJECTIVES si csscccssssuetioasescscccsstecc.. meeerer er een cssseeenueueaeneeesaae ogee wool 
B. BACKGROUND... 01... sercccsassosedensecdenscescseonnssseaveosdscuantadleteentsacesa0Ueee Ueteeess tet es =i Z 
1. Naval Postgraduate School AUV IT (NPS AUV II)................ secescccassassntssesecesessest en Ie 
2. Mission Planning Expert System.....................s.seccccsesseseescoccsssseosnsesacssicssncesseseesss cee Re, 
3. NPS AUV SimullatoT.:..cc.ccscsssccecssccesasceccsstscessocescossotdececsgnscocsevansess (ccceeteeeeane naman OER cine 3 
CeTHESIS ORGANIZATION ac eres nseenasnldasertt cea eRe | 
Il. AUTONOMOUS UNDERWATER VEHICLE RESEARCH................ccssssssscscssssssececesssesseceeses 6 
A. VEHICLE ARCHITECTUR EBisisss.. <:..2:0.:<sstescpesesesievascesseastagansssssseeseuncueeenaeeene anne soicbs nee 
1. Texas A & M............ccsscccsscossssncdsscssdsnnncesssesonceacecesecesnsenccaeseseensnesseccestenattes antes = tan 6 
2. Naval Ocean Systems Center (NOSC)..............ccccsssscsessceeceesssenees Soe eS. es 6 
» 3. Massachusetts Institute of Technology (MIT).................cccscssssssnccensscssccecceeescececscessesessesees a6 
4. Defense Advance Research Projects Agency.............csssscccccsssscsssscccssssccceescesssceceesecesseseesecees 7 
5. International Submarine Engineer ing...................0sscccssecssssssseseesenssscccsescosscecessess sent siden 
B. PATH PLANNIN Giesscq 2.25 eee ee 6s 9c Be 
1. General Path Planning. «occ. 3-5... ccceccccescusatocosasceseteteees eetee tacessss4ccsssacsbalassscecentn 550 en oy 
2. Fast, Three-dimensional, Collision-free Motion Planning...................ccsseccssccscesssesceccenscesnees 8 
a. General Description sc.c.2cc. ui ccc. 0s .008-sss sete Danced nctilvs sada idsecbaesdoosese eee ee re 
b. World’ Representationy....,..:..-:::sn eee neevaueeeyetnettees caatee sae 8 


1V 


oy SETS) Ted NV NTI G ENS Sie Ae ee oe ee eee 10 


REASONS IST OING eee ssre eee eee oe eer ee oa sada oo exo sans cabins ss OatealSuda ssuessasaseassdeleeauees<huasibiocesdeelans 10 

BB iditectional Stave: eUliSUC Se abil (15a. © )enc.uscs-cessccecceeesee 044 esassh csedseso2s ceceuedesssoteeyat ach oseces 10 
(CTS Te C2118 BeAve gio] 000) 0h ots co eae Re oF nec ee ear Sep ne PRU 10 

Do ee Stars cetencr ce tcce. cccsencessnssscusie teeter eTars tatitaperattieta gus teeiuic eeoninace eee Ea ee ee 12 
RBS oars een cece renee cen INES Moree Satauss nexsasausesten cnet aeoeteece wee (ats olneees RaSh iy 
Rept Anta Ces ANGUD IG aGy ANEAPES <1 se i -g5): Gh oh Dia, ke eee w, Naaabrecvysorad seen taSdaeucnec te 12 
COMM CUTAN ONS SPACE (eS Pace ) 25: tsatcsassexe sad. saree sasoctans suas ssetuasnscceeeatace ueeees utter cs 14 

UMC TAG CoN TG SCENT se ees sacar cou ccs easton ul oStau su aevssuacks notes cnduslechuecusics ides dacctns sce es Peaeaviaee: 14 

Ee KOSS oP aro 10 [ey Ter (ls A are eng ees er re Reo Pe eer Pp uae ne eee yey 14 

Bs (CROSS) COS Ta) Be ee PS ee ee ore eee 14 

Roma OU RNGT AN TONE laseerentaacens i sy sues es ucaened saa ncurienise eens Sc esceusacsencrcduss tuezts dialed douedcceveanuua sa caeuasses 14 

1, (GSTS PN) BLS26) of 002)» Pn aera mee EPR inper eterna ne renrginy cy eye Senn ror ITT e Yonrer iy MeO Trier sary reentry 14 

TOMY OP ICLOING PR ESE MPEALI OND Sacer oe ead ca ta co Veet l awl eate sac tade aubadoues chuavesccreviet denesans ace eterenee 15 
EMCI NLL SUCH irene es tase ce etic de wes tees tore meeks ee dendin ice chad ms Dewnn ns eee aene Ss sa tegen coe, nie eetee 16 

OME OAS ERT AKG cms e corse seats seas cos CON rae ea guks ects went Ok SUN woanaa acne What eon Cisne aaa ed atte es eather aaee: 16 
10. Tic leya ESB) IS) Sy. 4.2 Gl 5 Omenene nner ener ee tren Serie cetera ean om renee nen ane nr eseee rope nee 18 
JS. (CULE, N11] 57.9 REN PON rere ve ape Ee eran eer ory 18 
15), JL, SSE ANA SA SCG Rn reper peer rarer ea ree ne err Tehri cers rent nee vree rene Tetern Ty RU eereernrs err ree verre 18 
MW Os NIC TISION ALE RODIEMN,« co0el i100 coveevviiewees vs veuxsasic ease ss vraes see eeeadoeesec uses -esasreovaxt ites eee 18 
PROUD OMMENSION Al ELOO EMM ss oss ¢scsecrezasces aac coos sesso vasa aces ORs ness RRO Re sd tals Rae 19 
ND Aa PR SION DE SCRIP TION joiciseiiass 52.022 iesales caluloatscaat casas basse uence aa as et dca osestbasowrsee 19 
NPR TCT Maree ages eee Maes ewan ss ates ieacecsoyareaccieadwaa ss ius eesadengeranensuneuntasvoece: saclvaaeun tahseet pelts 19 


A. Memory Problem............0:ssssecsovssssesssoonssosssesesssceoesescesesonsysooeseoee/ etna gn 95) -5s= aaa 21 

b. Speed............ccssscessadsesdaccsansedcessolvaccseatecce settee aac eeeeet ache n=eest secs 1 </eint N tt asnsess stata 21 

3. Four Dimensional Problem. ..............sssessssesesecssscesesnesesaceesssveessasateltettteeemeeeenteestel tea an mana 22 

A. Modifications. ......:..s00.cccsecsccsensesseessoiskennsandesuacntess+sacsuccertescecahererseataie tists emma pap 

a. Smaller records........s.0ss.:sscssdsaiscsoavavsencesesavecuneaseseassussansscceeosanscosseeesteess=<t———=——-————n oe 

b. "F_MOVES".......cs:scsessecsssonsssevoeseseeesessecbacaesuss cae ceamne Reeeasa mss seeet satan a= as a2 

c. Waypoint capability.........c.ccccsssoeesssssesescsecseseaessos ADM eaesscsos ofoneSOceseent enn a ste 24 

5. The Tendril Search Algorithm..............:.cccssssssesssssasescsssessesoueesserseaseeeet teen eect oan oS 
D. TENDRIL BIDIRECTIONAL SEARCH..............c.sccssessccsovsaeoosrscacedeceoeetessaessstsseeeeteneaaaamnm oy 
1, CONCEP EL. cocecsccesacscnssanseccsecthectesssssscesecscessosanessesecessseceasacecceceess sa +e<2cs0eeeteeeeeeeee eaten 255) 

2. LIMIPATIONS..........cssccesecccssssassvsecaecesasnseasaaaesesecosagoeesiecserseeses roos'eeass¢¢7 02) teeeeeee eee eta Pall 
E. EVALUATION AND RESULTS. ...0....000.0.....0ccc:de000ccsss0esc0sesosedeeeleeeeeetee tte nteee eee 27 
IV. VECTOR FIELD METHOD...........cccccesessssesnsccsensnscsonssesesoasessuansessstess 4seeieeinte =201s === 29 
A. GENERAL DESCRIPTION. ........::cc0ssssscsvssssesessesssoensesesncers sounssesesnseseseiteness sete eeannammmmnm 29 
B. ADVANTAGES AND DISADVANTAGE G..................cssccsecoesccseccecsessccesconssesecces ee teeenenneaaam 31 
C. BASIC PROGRAM FLOW.........c..cccsssscesssesces sonccesesnecocsescanes constr retteeceecseee settee teeta 31 
D. THE DIRECTION SEARCH ALGORITHM...............cc::ccsccscsesesessassccseccasseees nett aaa 33 
E. RESULTS AND EVALUATION ...............c:cccosescssssssseaceossessscessossasosnnsereete teat ett st tana 33 
V. PATH REPLANNING ...........:..cccssssssosssssesvosscesvsnssseascvscesceneasseeeeeeeute tte coe nen naenanmnInT Ss settee 34 
A. GENERAL DESCRIPTION. .............01s00:0-sse0sssesesoacesennscsassettadeesess eae ee aaeaaaMen ee co 34 
B. JUSTIFICATION ...0c...cccscec.ocotodessssassoosstegcecuseevaaseeeeeeeseeer eatin sees et 1 sett eae 35 
C. DISADVANTAGES 0 oiisscccecvececscvesvivehseudisapuectice cesseneadt soecsesdeiasesavacstee eee tt 36 


vi 


War eONCEUSIONS AND RECOMMENDA TIONS rican cesc0c.50-csscesasesesssoucddsissces0cedensesevgereestesestess 37 
Pome WEVIATKY. AND CONCRUSIONS x22 ic. ci asec ininets sees boas shesaedevaarclsoudecasso8s-dshavesveststates 37 
J2h USE OIG DY PNY Y= 0 |G) (ae ee ee 37 

APPENDIX A - Data Flow Diagram for the NPS AUV IL... cc cccsesssseeesecesscesessessssecseseeees 39 

APPENDIX B - NPS AUV II System Block Diagram. ................cccsssssssccccsessssceccececesccsssssecssseeceees 40 

APPENDIX C - Three Dimensional Tendril Search in LISP.......... eee cecssreecesesseeeeecesessesesenes 41 

APPENDIX D - Data Dictionary, DFD, and program code for the TENDRIL Search.................... 48 

APPENDIX E - Data Dictionary, DFD, and program code for the TENDRILWP Search.............. 76 

APPENDIX F - Data Dictionary, DFD, and program code for the DIRECTION Search................ 86 

APPENDIX G - Data Dictionary, DFD, and program code for the RTA* Search...............ccccce0ee 110 

ssp 4S) 1s ACPD: 312 6 2) 21. f Cd Sc) SR RE Ry Pree Pee nee nen eee eee eee 135 

1S), SILJEGAGTSC20 Gl Ga RAR rer re on eee trator ne ene nn yon Pam ene eer erer ee errr errno a ener ener 138 

Ms renee Pe) ES TOPRIES UC) We OPIN DES oooh 0 ca oes ea poes se scnccc ac cosedeinasoecs seat ch cpactes sa beac ceseaesicusactleevesieeerss 141 


Vil 


Figure 1 - 1 
Figure 1 - 2 
Figure 2 - 1 
Figure 2 - 2 
Figure 2 - 3 
Figure 2 - 4 


Figure 2 - 5 


Figure 2 - 6 


Figure 3 - 1 


Figure 4 - | 


LIST OF FIGURES 


NPS AUV ID csccscccsuscsvevsssadecssassecaretocscanateetecesetee eset icc aetna ea 7 
Mission Planner Program Diagram................:cssesssssessensssseseseee-0 2000s 5 
Two Dimensional Legal Moves...................222:.0s-sesesseensescreseeessess ste 9 
Three Dimensional Legal MOve6S.....4..:..::..2...00000sseessessssassoooeee asset nna 9 
Bidirectional Search Process...............ccsrtisttveccsssescttecosccsessss sett 11 
Bidirectional Search Process with Waypoint.................cccssssscccsssssescessseees 13 
Expanded C-Space Obstacle 

for a Vehicle with a Fixed Orientation.................cscsssseccscecssossseceeteeteeeeeeenenn 15 
Potential Field Representationy................cc0ssesesssssssesocsrsecs cess scesesee steam 17 
Nine Legal Moves when Heading is Considered (Heading North)............ 20 
Representation of a Vector Field.............:ssssssscssssesssssnensecssenvenss ceaneennaaaamam 30 


I, INTRODUCTION 


Autonomous underwater vehicle (AUV) research continues to grow as more 
applications are devised. From industry and scientific research to military applications, 
AUV technology has generated great interest. Currently, there are nearly 30 different 
organizations researching AUV technology, of which 18 are government funded [Busby 
and Vadus, 90]. This indicates the strong interest the government has in this technology. 

The benefits provided by unmanned autonomous vehicles are many. They provide a 
means to accomplish missions which are considered too dangerous for human involvement 
[Cloutier 90]. “Progress is aimed toward minimizing need for man’s physical presence, 
intervention underwater” [Busby and Vadus 90]. Underwater vehicles can be categorized 
as either tethered or autonomous [Rogers 89]. In contrast to a remotely operated vehicle 
(ROV), an AUV is not restricted by an umbilical which can hinder task performance in 
some cases. 

Due to the AUV’s nature, mission planning and execution are very complex problems 
to solve. Accurate world models must be made and complex path planning performed prior 
to mission execution. During task performance, continued evaluation of the many aspects 
of the mission must be performed. If necessary, adjustment or replanning must be 


conducted to insure successful mission completion or a decision to abort. 


A. OBJECTIVES 


This thesis intends to focus on path planning and replanning using the Ada 
programming language [Healey 90}. Several objectives are listed below: 
1. Implement a multi-dimensional Tendmil search in Ada. 
2. Investigate the feasibility of waypoint utilization. 
3. Implement a Real-time A* (RTA*) path replanner in Ada. 


4. Investigate the feasibility of a vector field method of path planning. 


5. Examine the feasibility of utilizing Ada reusable modules. 
B. BACKGROUND 


1. Naval Postgraduate School AUV II (NPS AUV ID) 
The basic component layout of the NPS AUV II is illustrated in Figure 1-1. It is 
of aluminum box construction with a 16” beam, 10” height, 92” length and displaces 390 
pounds [Cloutier 90]. It uses eight independent control surfaces, four tunnel thrusters and 


two main screws, and has a top speed of two knots (three feet per second) with a 20 feet 


Sonar transducers Tunnel thrusters Drive motors 


NPS AUV I 
Figure 1-1 





turning diameter. Power is provided by on-board lead-acid battenes with an approximate 
two and one half hour operating time [Floyd 91]. Current on-board systems include a 
GESPAC MPU 20HF board with Motorola 68020 and 68882 processors. OS - 9 was 
chosen as the operating system for its multi-tasking capabilities. As recommended by 
Bihari, a full GESPAC suite is expected to be used for its suitability to AUV applications 
[Bihari 90). Appendix A and B are Data Flow Diagrams (DFD) and Software Heirachy for 


this project. 


2. Mission Planning Expert System 

The mission planning Expert System (MPES) is hosted on a Symbolics 3675 
LISP machine. Using the KEE expert system shell, it has four major components: the 
Mission Receiver, Mission Planner, Mission Constructor and Mission Executor. The 
Mission Receiver acts as the interface agent for user input. This information is passed to 
the Mission Planner which decides which path planning algorithm is best suited for the user 
supplied circumstances. Using various search technique including A*, and best-first search, 
the Mission Constructor does the actual path planning. The Mission Executor interfaces 
with the AUV/simulator and provides the appropriate mission data for execution. Figure 1- 
2 illustrates the MPES structure. [Ong 90] 


3. NPS AUV Simulator 


The NPS AUV II simulator contains a full set of submarine motion and 
hydrodynamics equations providing accurate, real-time simulation. Implemented on a SGI 
IRIS 4D/240 GTX graphics workstation, it displays a detailed underwater mapping of the 
Monterey Bay. Variable terrain resolution is used automatically to allow real-time 
operations. Its development is a joint effort between the computer science and mechanical 


engineering departments at the Naval Postgraduate School. [Jurewicz 90] 


C. THESIS ORGANIZATION 


Chapter II reviews previous and current work in AUV technology. A detailed look at 
various path planning techniques is provided. 

Chapter III introduces the Tendril search. The original two dimensional and the 
expanded four dimensional version in LISP are examined. Several learning points from the 
task of translating the LISP program to Ada are reviewed. Limiting features of the four 
dimensional Tendril search are presented as well as a look into the feasibility of the Tendril 
bidirection search (TBS). 

Chapter IV presents a vector field approach to path planning with a discussion of 
advantages and disadvantages. 

Chapter V presents a real-time path replanner using the Real-time A* Search (RTA*). 
Many questions are posed and plausible justification for the use of the RTA* is presented. 

Chapter VI provides conclusions and recommendations for further research. Heavy 
emphasis is placed on the recommendations, which provide good insight to the perceived 
goals of the NPS AUV research. 
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Figure 1-2 Mission Planner Program Diagram 


Il. AUTONOMOUS UNDERWATER VEHICLE RESEARCH 


A. VEHICLE ARCHITECTURE 


1. Texas A&M 
Texas A & M University has made major contributions to AUV technology 
conducting feasibility research. Reliability and fault tolerance were the primary concerns, 
and no vehicle construction was intended. To accommodate this, 16 Sun Sparc stations, 
fully distributed, were used (fully loosely coupled). [Cloutier 90] 

Programmed in the C language, it incorporated nine embedded knowledge based 
systems (KBS). Some important findings resulted from this research. The use of a “watch 
team” knowledge base (KB) was overly centralized. This KB simulated the tasks and duties 
performed by a human team aboard Navy submarines. By its centralized nature, results and 
decisions were predictable, however, flexibility was reduced. There is a trade-off between 
flexibility and predictability which must be closely considered [Cloutier 90]. 


2. Naval Ocean Systems Center (NOSC) 

NOSC pioneered AUV research in the 1980’s after extended involvement with 
remotely operated vehicle (ROV) research since the 1960’s. NOSC has several on-going 
research efforts. Advanced unmanned search system (AUSS) was developed for search and 
survey. The free-swimming mine neutralization vehicle (FSMNV) is also under 
development. [Busby and Vadus 90] 


3. Massachusetts Institute of Technology (MIT) 
The Massachusetts Institute of Technology developed Sea Squirt with funding 
from the National Oceanic & Atmospheric Administration and in cooperation with Draper 
Labs. It is a light weight, low-cost AUV primarily used as a test platform for intelligent 


algorithms. The research goal is to make a vehicle capable of operations in an adaptive 


manner with respect to its environment in an uncharted area [Busby and Vadus 90]. 
Onboard systems include a GESPAC MPU - 20 board with a Motorola 68020 cpu and runs 
OS - 9, like the NPS AUV II [Bellingham 90]. 


4. Defense Advance Research Projects Agency 

The Defense Advance Research Projects Agency (DARPA) has been actively 
involved in AUV research. It has provided about 90% of the research funding throughout 
the research community and industry. As early as 1988, DARPA initiated projects with 
Draper Laboratory and Martin Marietta. These projects focused on the research and 
development of two vehicles and intelligence task research. Martin Marietta also planned 
to develop a “hard time” aspect to navigation that entailed planning a path where arrival 
times at specific way points are known before hand and met during execution. In 1989 
DARPA in conjunction with Lockheed Missiles and Space Company began development 


of an autonomous mine avoidance vehicle. [Busby and Vadus 1990] 


5. International Submarine Engineering 
Over the years, International Submarine Engineering, Ltd. (ISE) has developed 
several unmanned underwater vehicles (UUV). Its DOLPHIN was a diesel powered vehicle 
designed for offshore hydrographic mapping. The interesting aspect of this vehicle is the 
use of GESPAC components. After an extensive market survey, GESPAC was chosen for 


its price, performance, size, ruggedness and availability. [Zheng et. al. 90] 
B. PATH PLANNING 


1. General Path Planning 
The ultimate goal of a path planner is to derive a continuous set of free space 
points from the starting position to the goal position [Latombe 91]. For control of 
autonomous vehicles this can be done at various levels of resolution. A route planner is 
used at low resolution and a path planner provides a more specific solution to the path 


planning problem. In essence, the path planner provides a detailed path for the various path 


segments generated by the route planner [Ong 90]. This thesis concentrates on the path 
planning resolution. 

Path planning is a well researched topic with many search techniques being used 
in various research efforts. Most commonly used methods are: Breadth-first, A*, Hill 
climbing, Depth-first and Best-first. Some of these will be presented later in this chapter. 

Important to note is the complexity of the search methods. As search space 
increases, some techniques, especially exhaustive methods, tend to be restrictive either due 
to memory or time requirements. Branching factor is an important aspect to consider. In a 
two dimensional search space there may be as many as eight adjacent nodes that the vehicle 
can legally move to as illustrated in Figure 2-1. With the addition of a third dimension these 
legal moves increase to 26 as illustrated in Figure 2-2. Methods are required to sufficiently 


reduce the branching factor to make these techniques viable. [Ong 90] 
2. Fast, Three-dimensional, Collision-free Motion Planning 


a. General Description 
Implemented in a nodal search space representation, this method successively 
divides the search space into homogeneous octrees or to a set resolution limit (section b 
below provides more detail on octrees). The less node division that is necessary, the easier 
for the path planner to process the search space. It is evident that planning a path in a search 
space with a small number of nodes is easier than to do so in a search space with a large 


number of nodes. [Herman 86] 


b. World Representation 


Upon initialization, the world is represented as a single node. If the node is 
not homogeneous (either wholly obstacle or free space) it is divided into eight children 
nodes. Each new node is evaluated for homogeneity and if necessary divided further. This 
process continues until all nodes are either wholly obstacles or free space, or the resolution 
limit is reached. A tree structure is formed with the original node as the parent and the 


resulting octree nodes as the children. 
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Figure 2-2 Three Dimensional Legal Moves 


c. Search Techniques 
Several search methods were incorporated in this method, to optimize time 

and memory use: 

1. Hypothesis and Test, 

2. Hill Climbing, 

3. A*. 
The process started with the hypothesis and test method and switched to the hill climbing 
method. When local maxima were encountered the A* process was used to overcome them. 


Once past the local maxima, the program continued with the hill climbing process. 


d. Conclusions 

It is important to note that this method may not find the minimal cost path and 
only finds an adequate cost path. This may or may not be sufficient for some path planning 
needs. 

Another consideration is the use of several methods for path determination. 
The advantage of using multiple methods is to avoid “traps” such as local maxima that 
could stop a search from finding a path to the goal where one exists. Other individual 
methods may not encounter local maxima “traps” but may be time restrictive. Thus for 
timing considerations a less exhaustive method is used and the “traps” must be considered. 
By making this time trade-off, other methods are required where one method may fail. 
Although acceptable, using multiple methods adds to the complexity of the problem and 


appears to provide little overall advantage in computational speed. 
3. Bidirectional Staged Heuristic Search (BS*) 


a. General Description 
This technique can use any of the basic methods listed in the first paragraph 
of this chapter. What makes this approach unique is how that basic method is used. BS* 1s 


actually two searches: one Starting at the starting point and working towards the goal, the 


other starting at the goal and working towards the starting point. After each iteration a 
“wave” of acceptable moves is generated for each search. When the two waves meet at a 
connecting point a path from the starting point to the goal is completed. Figure 2-3 
illustrates the BS*. [Kwa 89] 


Wave front for START to GOAL search 





Wave front for GOAL to START search 


Figure 2-3 Bidirectional Search Process 


b. Trees 
As the search expands on a node finding its subsequent legal moves, a tree- 
like structure is generated. Here the branching factor becomes a problem: the trees grow 
exponentially. Various methods, like pruning and trimming have been used to reduce the 
size of the trees and provide more efficient processing. It has been proposed that generating 
two trees, vice one, reduces the total effort of processing the search space. Therefore, by 
dividing the search process into two halves (start-to-goal, and goal-to-start) the trees 


generated are overall smaller than that generated by a single direction search. [Kwa 89] 


c. Cost 

With the reduction of tree size and search space, it would be logical to assume 
the process to require less time to generate a path. This, however, is not the case. After each 
iteration a check must be made to determine if the two search halves have met. This check 
can be a costly process and may not reduce overall computational time. 

Other researchers have tried to “push” or “nudge” the search tree growth 
along an expected path and thereby reduce the number of “open” nodes. This, however, can 
lead to a non-admissable solution to the problem and a less then optimal path may be 
generated. Kwa uses nipping, pruning, trimming and screening to help reduce the number 
of open nodes and reduce run-time. Nipping, pruning, trimming and screening are 


techniques used to eliminate paths that are obviously too costly. 


d. Advantages and Disadvantages 


The most noteworthy advantage is that this method can be executed on a 
parallel processing computer. With a multi-processor system such as the T-800 transputer, 
each processor could perform a search. Taking this one step further, consider a path with 
an intermediate way-point as indicated in Figure 2-4. A multi-processor system could 
process each path segment (Start-to-waypoint, waypoint-to-start, goal-to-waypoint, 
waypoint-to-goal) on different processors. The same problem of checking for the 


connecting point is still unavoidable. 
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Figure 2-4 Bidirectional Search Process with Waypoint 


4. Configuration Space (C-space) 


a. General Description 
The underlying assumption of C-space path planning 1s that it is easier to plan 
for a point size vehicle then for a rigid body vehicle. By reducing the vehicle representation 
to a point, the world model must be altered so that a safe path can be planned. How the 


world is changed is the interesting aspect of this technique. [Warren 90] 


b. C-Space Obstacles 
Since the rigid body vehicle is represented as a point something must be done 
to insure a safe path is planned [Lozano-Perez 83]. To accomplish this, obstacle size is 
altered to reflect a vehicle size buffer as shown in Figure 2-5 [Latombe 91]. It is important 
to note that obstacle buffer size varies depending on the vehicle orientation. Each 
orientation specific obstacle is called a shield and can be calculated at run-time to reduce 


preprocessing workload. [Latombe 91] 


c. Conclusion 
C-space obstacle representation may be good where very precise navigation 
is necessary. Calculations for vehicle representation are reduced by representing the 
vehicle as a point but computational time is increased by the requirement for calculating 
the shields for each orientation. The four-dimensional Tendril search uses a very simplified 
C-space concept. Orientation is limited to the four cardinal headings and each node is 


represented by four shields. 
5. Potential Field 


a. General Description 
Given a girded or nodal search space, potentials are assigned to each node. 
These potentials are based upon proximity of a node to the goal or an obstacle. Nodes with 
obstacles in close proximity will have a repulsion potential since it 1s undesirable to 


position a vehicle in these nodes. Other nodes provide a free and clear path to the goal and 
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thus are assigned an attraction potential. Once the potential field is established any search 


technique can be used to find the least cost path.[Warren 90] 
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Figure 2-5 Expanded C-Space Obstacle for a Vehicle with Fixed Orientation 


b. World Representation 
Figure 2-6 shows how a potential field can be represented. Free space is 
assigned a potential based on the square of the distance from the goal. Nodes near obstacles 
are assigned a potential based on the reciprocal of the distance from the obstacle, squared. 
After preprocessing the search space, assigning potentials, a topology or landscape is 


developed that allows a vehicle to travel “downhill” to the goal.[Warren 90] 


c. Conclusion 
Again, local maxima can cause a problem by “trapping” the search. Figure 2- 
6 displays this and indicates the need for an alternate search method. In the figure, the 
shortest path would be along the diagonal between the start and goal. The potentials, 
however may drive the path in a less optimal direction or worse; trap the path at the local 
maxima. The Direction search incorporates the potential field concept at a very abstract 
level. Values are not assigned to each node, however, a “pointer” to the next node in the 


shortest path to the goal is stored at each node in the search space. 


6. Remarks 
Each of the techniques presented have been researched well and the use of 
multiple methods has been explored, yet combination of techniques in a single search is 
somewhat rare. Each has its merit and could easily be incorporated in varying degrees of 
complexity to produce an efficient path planner. The search techniques to be presented in 
the following chapters use some variation of these techniques. The predominant difference 
from previous research is that some of these techniques are combined into a single search 


process. 
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Figure 2-6 Example Potential Field Representation 
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Ill. THE TENDRIL SEARCH 


A. GENERAL 

In the Tendril search, the search space is represented by an multi-dimensional array, 
or lattice of nodes. Each node maintains several attributes to facilitate the path planning 
process. One of the attributes is a list of the node’s immediate neighbors, with an associated 
cost to move to each neighbor. Only non-obstacle neighbors are maintained in this list and 
represent the legal moves that can be made from the node. The legal moves from the 
starting point represent the first WAVE. Legal moves are found for each node of this 


WAVE and the process continues generating subsequent waves until the goal 1s reached. 
B. LISP VERSION 


1. Two Dimensional Problem 

Originally written for a two dimensional search space [McGhee 90], there are 
eight potential legal moves (one for each cardinal direction and one for each diagonal 
move) that can be made from the starting point. These legal moves are placed in an “open” 
list, WAVE, of nodes to be expanded upon. The next wave is determined by finding the 
legal moves for each node in the WAVE list. As each node is processed it is assigned a 
tendril length representing the length of the current path from the start to that specific node. 
There is an exponential increase in the number of nodes for each wave which could cause 
limitations due to memory requirements. Since individual nodes can be reached via 
multiple paths, it is important to consider each one so the shortest can be selected. By 
pruning previously processed nodes whose assigned tendril length is less than that of the 
current waves calculation for the tendnl length, the longer and redundant paths are 
eliminated. This specifies that the node can be reached by a shorter path and the current path 


need not be investigated. The pruning process helps to reduce the time required to 
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preprocess the search space. Even so, preprocessing of the search space for each node’s 


legal successor is not feasible, especially for real-time constraints. 


2. Four Dimensional Problem 

When a third dimension (depth) is considered, the problem becomes very 
complex. Each node has 26 possible legal moves. This is unacceptable if real-time path 
planning is needed. To reduce this number an additional dimension is considered, heading. 
It is not unreasonable and is only natural to consider orientation when planning a path. Only 
the cardinal headings (North, East, West and South) are considered in this program. Since 
a vehicle must have a heading the number of legal moves can be reduced to nine as shown 
in Figure 3-1. Thus the two dimensional problem is easily expanded to four dimensions 
with little increase in computational complexity. More details of this program are found in 


[Bonsignore 90]. Appendix C lists the four Dimensional LISP code (3dh.lisp). 
C. ADA VERSION DESCRIPTION 


I. General 
‘““Why use Ada?” is a question surely posed by some researchers. Through a recent 
mandate, the government requires the use of Ada for its software projects. This, however, 
is not the driving force behind the use of Ada for this thesis. Ada was designed for use in 
large programming projects. With characteristics such as separate compilation and generic 
procedures, it facilitates the modularization of programming projects and allows several 
programmers to work individually. Modularity also helps with program maintainability. 
Ada provides multitasking and timing constructs which facilitate real-time systems 
programming [Voltz, et al 84]. All of these attributes make Ada especially suitable for 
AUV programming. 
The initial intent of this thesis was to build a path planner with Ada reusable code. 
Some difficulties with reusable code were encountered. The Ada software repository at 
White Sands Missile Range is not quite “user friendly”. Very general procedures, such as 


building linked lists, were acceptable. More sophisticated code, however, was often 
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Figure 3-1 Nine Legal Moves When Heading is Considered 
(Heading North) 


difficult to find. Some of these procedures were not stored with “user friendly” file names 
and often stored with coded names, making quick access difficult. Even when the 
appropriate code was obtained and the module found to be usable, many modifications 
were required. On large projects these modifications and subsequent testing may be more 
costly then writing the procedures from scratch [Gaffney 89]. For these reasons this thesis 


does not take advantage of reusable Ada software. 


2. Direct Translation 
An initial attempt at programming in Ada was made by making a direct 
translation from LISP. All the LISP structures and functions were translated into Ada 
records and procedures. This task was not easy since the two languages are very different. 
Many modifications, although small, were required in the Ada code due to these language 


differences. 


a. Memory Problem 

A major difficulty with the direct translation was that of memory usage. The 
LISP version preprocesses the search space assigning a list of possible legal moves from 
each node. In a two dimensional problem there are eight legal moves for each node (the test 
search space is a 10 x 20 array resulting in approximately 1600 legal moves). The memory 
requirement for this can be too large for some systems (as was the case for a modestly 
configured 386SX). Preprocessing is wasteful since nodes that do not require processing 
were processed anyway. These problems were solved by modification in the Ada version 


which will be presented in subsequent sections of this chapter. 


b. Speed 


Due to the extensive search process requirements, the speed at which the 
LISP version ran was slow. The directly translated Ada version did not run at all due to 


system memory constraints, therefore no timing characteristics are available. 
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3. Four Dimensional Problem 
Expanding the two dimensional problem to incorporate depth and heading 
drastically increased memory requirements since the number of legal moves over tripled 
resulting in a combinatorial explosion. As earlier stated, this was solved by considering 
only those moves that the vehicle can immediately transition to when the vehicles heading 
is taken into account. By considering orientation in the search process unnecessary path 


searches were eliminated. 


4. Modifications 
Many modifications were required to enable the four dimensional Ada Tendril 
search to run. Some changes were very simple and others required a complete rewrite to 
achieve the efficiency required. Appendix D is a data dictionary, DFD, and code for this 


process. 


a. Smaller records 
The LISP version record structure for a node maintained a list of all legal 
moves possible from that node. By eliminating this attribute the size of the record was 
substantially reduced thus easing the limitations imposed by memory restrictions. Section 


b. below describes how the legal moves are determined. 


b. “F_MOVES” 

To reduce memory requirements the preprocessing of the search space was 
eliminated. Instead, the legal moves were determined as each node was reached in the 
search process. Thus if looking for a path between two adjacent nodes the legal moves for 
the nodes far removed from the possible path are not determined. Listed below, is the 


pseudo-code representation of this process. 


procedure F MOVES (N_ARRAY : in out NODE_ARRAY; 
ROOT : in out LIST_PTR) is 


oops 


HEADING : INT_TYPE := ROOT.LOC(4); 


begin 
case HEADING 1s 
when the heading is north=> 
check the upper northwest node 
check the upper north node 
check the upper northeast node 
check the northwest node 
check the north node 
check the northeast node 
check the lower northwest node 
check the lower north node 
check the lower northeast node 
when heading east =>... 
when heading south =>... 
when heading west =>... 
when others => 
null; 
end case; 
end F_MOVES; 


procedure F_PATH (N_ARRAY : in out NODE_ARRAY) 1s 
ROOT : LIST_PTR := WAVE; 


begin 
while the root contains valid information loop 
F_MOVES (N_ARRAY, ROOT); 
ROOT := WAVE.NEXT; 
end loop; 
if the goal is found then 
return to the main process (DO_SEARCH) 
end if; 
end F_PATH; 


F_MOVES, called from within F_PATH, takes as input the search space (N_ARRAY) and 
the current node being processed (ROOT). Using the ROOT’s heading the nine legal moves 
are determined. Each legal move is processed and if the GOAL is among them, the search 


is complete, otherwise they are assigned to a list called WAVE. The legal moves for each 
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node in WAVE are then generated and the process of checking for GOAL is repeated. This 


continues until the goal is found or all nodes are processed without reaching the GOAL. 


c. Waypoint capability 
It is conceivable that an AUV may need to navigate to some intermediate 
points that may not be along the optimal path between the start and goal. For this reason a 
waypoint capability is required. The algorithm below illustrates the TENDRILWP search 


in pseudo-code which allows multiple waypoint path generation. 


procedure TENDRILWP is 


begin 
GET_DATA; 
DO_SEARCH; 

end TENDRILWP 


procedure GET_DATA is 


begin aie 

while there are still points to enter loop 
get way point coordinates 
exit when done 

end loop 


procedure DO_SEARCH is 


begin 
read in the terrain data 
create the output file 
loop 
exit when the second node in WAVE is null 
while WAVE is not empty and the goal isn’t found 
F_PATH 
end loop; 
print the path 
reset the search space and variables to initials values 
end loop 
Close the output file 
end DO_SEARCH 


The tendril search technique 1s used in each path planning segment. A “while...loop” 
construct was added to the DO_SEARCH procedure (in the PATHWP package). Each 
waypoint is processed in order, finding a path between each of two successive points. The 
generated path segment is printed to a file and the next two points are processed until 
complete. Upon completion of a path segment many variables need to be reset to their 
initial values to allow the next path segment to be generated. The RESET_ALL procedure 
resets global variables. 

This path planning technique divides the search into several small searches 
lending itself to concurrent processing. While one processor finds a path from the start to 
the waypoint, another processor could find the path from the waypoint to the goal. This 
version does not take advantage of concurrent processing, it finds each path segment 
sequentially. Appendix E contains the Data Dictionary, DFD and program code. 
Limitations 

As previously indicated, memory and speed have continued to be a concern in this 
methods efficiency [Richbourg et. al. 87]. If the whole search space needs to reside in 
memory, it is restricted by the machines capabilities. If time constraints permit, reading and 
writing to a file may be a feasible solution. This aspect was not investigated in this thesis. 
It is interesting to note that as the obstacle density increases, a larger search space can be 
stored in memory without causing memory problems. This is a result of “pruning” the 
obstacle nodes from the legal move and open node lists. As the number of obstacle nodes 


increases the free space is logically decreased. 


5. The Tendril Algorithm 
The Tendril search takes as input the starting coordinates including orientation 
(row, col, dep, hdg) and the goal. Terrain data is read from a file and is implemented in a 
dynamic array described by the first few items (array dimensions) read from the file. From 
the starting point and consistent with the initial heading, the legal moves are determined 
and assigned to WAVE. Each node in WAVE is assigned a parent node (in this case the 
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parent is the starting point) and its tendril length 1s calculated from the tendml length of the 
parent plus the distance from the parent to that node. Checks are made to ensure nodes 
previously processed are not reprocessed unless the resulting tendril length is shorter than 
the nodes current tendril length. This process is performed on each node in WAVE which 
generates another wave. Iteratively, it continues until a wave reaches the goal. Once the 
wave containing the goal is fully processed, the program stops the search and backtracks 
from the goal, via its parent “pointer” to the start, printing out the path (or writing it toa 


file). Listed below is the pseudo-code of the Tendril search. 


procedure TENDRIL is 


begin 
GET_DATA; 
DO_SEARCH; 

end TENDRIL; 


procedure GET_DATA is 


begin 

get the terrain file name 

get array data 

get START and GOAL coordinates 
end GET_DATA 


procedure DO_SEARCH is 


begin 
get the terrain data 
while the WAVE list is not empty loop 
F_PATH 
exit when the goal is found 
end loop; 
print the path 
end DO_SEARCH 


As previously described the F. MOVES procedure performs most of the work. It 
checks for the ROOT’s heading and uses a case statement to handle each of the cardinal 


headings. For example, when the vehicle is heading north (HDG = 1) only the nine nodes 
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in a northerly direction are evaluated. These evaluations are performed in the 
THE_MOVES package. Each CHECK_ NODE (where NODE represents one of the nine 
legal moves) procedure determines the coordinates of the legal node being evaluated and 
calls the CK_STATE procedure. In CK_STATE the node’s state is determined to be either 
free space or obstacle space. If the node is free space, the GROW_TEND process is called. 
This process adjusts the tendril length, assigns the parent (ROOT), and attaches that node 
to the NEW_WAVE list. Other procedures are used to process the WAVE and 
NEW_WAVE lists in support of the FLMOVE procedure. 


D. TENDRIL BIDIRECTIONAL SEARCH 


1. Concept 
Although not implemented in this research the Tendmil Bidirectional search (TBS) 
appears to be a viable solution to real-time processing problems. This method lends itself 
well to concurrent processing as previously described for the Tendril search with 
waypoints. With the installation of a T-800 transputer board into the NPS AUV II, 


concurrent processing is highly desirable and achievable. 


2. Limitations 
An important consideration is the need to check for completion after each wave 
iteration. This could be a difficult problem, reducing the advantages of concurrency by 


requiring a high degree of communication between each search process. 


E. EVALUATION AND RESULTS 

For ease of comparison, a smaller terrain representation was used in the evaluation (5 
rows X 5 columns X 5 depths X 4 headings). When tested with an obstacle free model, the 
paths generated in both the Ada and LISP (compiled) versions were identical. The Ada 
code was much faster (.24 seconds vice .933 seconds for LISP). It is especially significant 
considering the following facts: While the LISP version has the terrain data hard coded, the 


Ada version must open and read the data from a disk file. The Ada version writes its results 
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to the screen and to a file. Both of these differences are I/O processes which are time 
intensive. Even with these I/O hindrances the Ada version was the fastest. In an obstacle 


intense terrain model, results were similar. 


IV. VECTOR FIELD METHOD 


A. GENERAL DESCRIPTION 


Although a very simple process, this method has proven to be the most efficient of 
those investigated in this thesis. Listed below, is the pseudo-code for the DIRECTION 


procedure. 


procedure DIRECTION is 


begin 
GET_DATA 
DO_DIR 

end DIRECTION 


procedure GET_DATA is 


begin 

get the terrain file name 

get array data 

get START and GOAL coordinates 
end GET_DATA 


procedure DO_DIR is 


begin 
get the terrain data 
FIND_MOVES 
FIND_PATH 
P_PATH 

end DO_DIR 


The legal moves are determined by searching backwards from the goal. The node attribute, 
NEXT, stores the coordinates of a successor node having the shortest distance to traverse. 
As legal moves are determined the NEXT attribute is assigned the coordinates of the node 
being expanded. Therefore the nodes generated from the goal will have the goals 
coordinates stored in the NEXT attribute. Figure 4-1 illustrates the backwards search 


process and direction assignment for a three dimensional problem (row, column, and 


heading) with the GOAL having a southerly orientation. The numbers in each node 
represent the order that they were processed during the search. Two nodes adjacent to the 


GOAL remain unassigned because it is impossible for these nodes to move directly to the 





Figure 4-1 Representation of a Vector Field 


GOAL with the proper orientation. This is not the case in the four dimensional problem 
(including depth). A transition in depth will allow all paths to the GOAL to be generated. 
Nodes are processed with a priority. A move not requiring a heading change is 
less expensive than moves that do. Nodes are put into a search queue based on the cost to 
move into the next node. The entire search space is processed this way, resulting in 
‘vectors’ being assigned to every free space node. Once the starting point is entered, all 


moves to the goal are immediately available. 
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B. ADVANTAGES AND DISADVANTAGES 

The most obvious advantage is the speed at which this process runs as compared to the 
Tendril search. To find a path, the user provides the starting point. Each individual node 
“knows” its next move to reach the goal. Path determination is just a matter of following 
the NEXT attributes until the goal is reached. No calculations are required during the path 
planning process making it very fast. 

Other searches need both the starting point and the goal to preprocess the search 
space. The Direction process needs only the goal to prepare the search space. Since the 
preprocessing is not dependent on the starting point, many trials with various starting points 
can be investigated with only the cost of the preprocessing once. 

Another advantage is the ease at which obstacles are handled during the process. 
Originally written for only non-obstacle terrain, a small modification was required to 
handle obstacles (i.e. an obstacle is an illegal NEXT move). 

As can be seen in Figure 4-1, all the paths to the GOAL may not be generated. If the 
starting point is the node just to the right of the GOAL, a path may not be found (where one 
exists) to reach the GOAL with the appropriate orientation (southerly heading). This 


disadvantage can be overcome when considering a four dimensional problem. 


C. BASIC PROGRAM FLOW 


Similar to the Tendril search, terrain, starting point and goal information are taken as 
input. Some of the procedures are exactly the same as those used in the Tendril search, 
while others required minor modifications. Most notably is that FIND_MOVES procedure 
processes legal moves in “reverse” from the F_MOVES procedure in the Tendril search. A 
pseudo-code version of this procedure is listed below. It finds all the legal moves from 
which the goal can be reached as opposed to which node can be move into from the starting 
point. The legal moves are placed into a queue of active nodes, ACTIVE, based upon a 
predefined order relative to heading. The ordering results in the nodes with the least cost 


being at the head of the queue and the rest follow in increasing cost order. Each member of 
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the ACTIVE queue is processed in a similar manner with its legal moves being appended 
to the end of the queue. As each node is processed its NEXT attribute is assigned the 


coordinates of its parent. This is, essentially, a pointer to the shortest move to attain the 


procedure FIND_MOVES (N_ARRAY : in out NODE_ARRAY) is 


heading : INT_TYPE := ACTIVE.LOC(4); 
list - LOC_ARRAY := ACTIVE.LOC; 
new_list: LOC_ARRAY := ACTIVE.LOC; 


begin 
while the ACTIVE list is not empty loop 
heading := ACTIVE.LOC(4); 
list := ACTIVE.LOC; 
new_list := ACTIVE.LOC; 
case heading is 
when heading north => 
check the southern node 
check the upper south node 
check the lower south node 
check the southeast node 
check the upper southeast node 
check the lower southeast node 
Check the southwest node 
check the upper southwest node 
check the lower southwest node 
when heading east => ... 
when heading south => ... 
when heading west => ... 
when others => 
null 
end case; 
end FIND_MOVES; 


goal. Processing the entire search space results in every free space node being assigned a 
NEXT node to move to and a cost associated with that move. Obstacles are not processed 
and a NEXT move cannot be assigned the coordinates of an obstacle. The A_LAND_A 


(analyze and assign) procedure insures the assignment of the NEXT attribute is done 
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properly. The P_PATH process generates the path. Beginning with the starting node, it 
follows the NEXT “pointers” until the goal is reached and writes the nodes to a file. 


Appendix E contains the Data Dictionary, DFD, and program code. 


D. THE DIRECTION SEARCH ALGORITHM 

Producing most of the work for this technique is the, previously mentioned, 
FIND_MOVES procedure. Having passed in N_ARRAY (the array of nodes) it uses the 
GOAL and a case statement to determine legal moves. It is very similar to the F MOVES 
procedure in the Tendril search except that it works in “reverse.’’ Looking at the orientation 
required in the GOAL, it determines what node an AUV can transition from to attain that 
GOAL. Procedures in the THE_MOVES package then determine the coordinates of these 
nodes and calls the A_AND_A procedure (analyze and assign). In this procedure it is 
determined if the nodes are free or obstacle space. If a node is free space it is assigned a 
value, DIST, equal to the distance that must be traversed to enter that node. It is also 
assigned to the ACTIVE queue in a specified order as previous detailed. Other procedures, 


similar to the Tendril search, are supporting means for processing the ACTIVE list. 


E. RESULTS AND EVALUATION 

Similar to the timing results of the Ada version of the Tendril search, the Direction 
search is significantly faster then the LISP Tendril search. The results of a search conducted 
in an obstacle free space produced similar results, although slightly faster (.2271 seconds 
vice .233 for Ada Tendmril). This timing variance may be explained by I/O differences. A 
significant timing difference was noted between the searches in an obstacle intense 
environment. The Direction search was much faster (.11 seconds vice .329 seconds). This 
is attributed to the different way obstacles are handled in the two programs. The Direction 


search has much less overhead for handling obstacles. 
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V. PATH REPLANNING 


A. GENERAL DESCRIPTION 

A path replanner is a path planner with more stringent time constraints. It is needed 
when an AUV is required to circumnavigate an unexpected obstacle to continue its mission. 
This replanner must, therefore, operate in real-time to facilitate an efficient transition to an 
alternate path. 

The Real-time A* (RTA*) algorithm presented by Korf [Korf 88] was modified to 
incorporate four dimensions. This method can use any of the previously mentioned 
techniques for searching (Best-first, Tendril, etc.) but only searches to a specified search 
depth. Nodes at the search depth are called frontier nodes.The method implemented in this 
thesis uses the Tendril search to a search depth of three nodes. As the search progresses, the 
cost of reaching the frontier nodes is calculated. Adding this cost to an estimate to reach the 
goal, the frontier node with the lowest overall cost is chosen to be expanded upon. The 
process 1s repeated at this intermediate frontier node and successively until the goal is 
reached. Appendix F contains the Data Dictionary, DFD and program code. Pseudo-code 
for the RTA* search is listed below. 


procedure RTA is 


begin 
GET_DATA 
DO_SEARCH 
end RTA 


procedure DO_SEARCH is 


begin 
get the terrain data from file 
while the goal is not found loop 
find the frontier nodes 


pick the node with the estimated least cost 
end loop 
print the path 
end DO_SEARCH 


B. JUSTIFICATION 

Previously presented search methods may not be efficient enough for real-time path 
replanning. As a possible solution to this problem, the RTA* technique was investigated. 
Due to the nature of the AUV’s working environment it is feasible to “expect the 
unexpected.” The dynamic nature of the undersea environment can alter terrain and 
obstacles swiftly, rendering preprogrammed paths obsolete. For this reason an on-board 
replanner is required which must operate in real-time. 


Many considerations went into the implementation of the RTA* for this thesis: 


1. What search method should be used to find the frontier nodes? 

2. What should the search depth be? 

3. Would the old path be completely disregarded or should a new path try to return to the 
old path as soon as possible? 

4. Should this procedure handle the initial collision avoidance maneuver? 


5. How “real’’ is real-time? 


These questions had to be properly answered to produce a true real-time path 
replanner. Since this thesis predominately examined the Tendril search, it was determined 
that it should be used for the search method in the RTA*. The search depth was arbitrarily 
chosen at five nodes and later reduced to three because of memory limitations. Old path 
data is discarded and the new path does not attempt to “get back on” the old path. Initial 
collision avoidance 1s to be performed by a different procedure and this RTA* would be a 


path replanner only. Strict real-time constraints have not been set. 
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C. DISADVANTAGES 


Although good for two dimensional problems, the RTA* is very memory intensive for 
multi-dimensional problems. As waves are processed the legal moves for all nodes up to 
the search depth must be retained. To illustrate the exponential growth of search nodes, 
consider a starting point that has only three legal moves in its first frontier. At a two node 
frontier distance (or second frontier) 27 legal moves must be maintained and 243 legal 
moves at a three frontier. A combinatorial explosion results with further processing. For a 
moving vehicle, a three node length look ahead capability may be insufficient (depending 


on node size) for obstacle avoidance reaction time. 


D. EVALUATION 


Due to the massive memory requirements, this process appeared to be fruitless 
especially when the good results of the previously presented methods are considered. Upon 
a second consideration, it is feasible to incorporate pruning methods to help eliminate 
unnecessary processing of nodes which should not be processed. Pruning techniques were 
successfully used in the other methods and therefore should not be difficult to implement 


into the RTA* search. Further research with this method is recommended. 
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VI. CONCLUSIONS AND RECOMMENDATIONS 


A. SUMMARY AND CONCLUSIONS 


This thesis investigated several path planning techniques using a nodal representation 
of the search space. A four dimensional Tendril search was implemented in Ada and a time 
comparison to a LISP version was made. The results indicate that it is feasible to use Ada 
for intelligent, real-time path planning. One version of the Tendril search incorporated a 
waypoint capability. It is an important aspect that should be looked at more carefully for 
implementation in the NPS AUV II. 

The Direction search, using a vector field was implemented. This method proved to be 
the fastest of the methods investigated. Due to its speed and simplicity, it is highly 
recommended for the NPS AUV II replanner for the near term. 

The RTA* search initially appeared to be cumbersome for multi-dimensional path 
replanning. Upon reconsideration, it could be modified to take advantage of pruning 


techniques to eliminate unnecessary node processing. 


B. RECOMMENDATIONS 


Each method of path planning investigated was valuable for various reasons. 
Simplicity was the prevailing aspect in all methods which, in turn, resulted in small time 
requirements for search space processing. Of these procedures the Direction search was the 
simplest and fastest, thus recommended for further research to incorporate into the NPS 
AUV II as the onboard path replanner. 

It should be noted that there are limited orientation capabilities for each method. 
Although only the cardinal headings were used, the results are sufficient for path-planning 
purposes. The guidance module of the NPS AUV II does not use the orientations produced 


in the path planning process. It uses only three dimensional coordinates, generating 


6) 


orientation more accurately itself. Thus, the course orientations of these path planners are 
only for their internal use to accommodate more accurate planning. [Magrino 91] 

The use of waypoints is a very important feature of path planning, whether for an 
aircraft, AUV, or a trip to the corner market. Use of the Direction search with a waypoint 
capability is recommended for further research. It may be difficult or time restrictive since 
the vector field generated depends on the goal. A new vector field is required for each path 
segment. Consideration should be given to dividing the search space into portions, each 
path segment having its own portion of the search space eliminating the requirement to 
reinitialize the entire search space after each path segment is planned. 

The Tendril Bidirectional Search (TBS) lends itself to concurrent processing. The use 
of transputers could make this an exceptional method for real-time path planning. 

Consideration should be given to the use of multiple path planning and replanning 
methods. Planning for obstacle intense environments is significantly different from 
obstacle sparse environments. In most cases it appeared that the easiest path to plan (no 
obstacles) took the longest time. The Mission Planning Expert System has the capability to 
determine appropriate planning methods yet it has very few methods implemented. Further 


research is required to build upon the MPES path planning methods. 
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APPENDIX A - Data Flow Diagram for the NPS AUV II 
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APPENDIX B - 


NPS AUV II System Block Diagram 
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APPENDIX C 
Three Dimensional Tendril Search in LISP 


defstruct node state parent tendril-length link-list) 

(defvar *new-active-node-list* nil) 

(defvar *active-node-list* nil) 

(defvar *goal* nil) 

(defvar *goal-flag* nil) 

(defvar *node-array* (make-array ‘(67 7 7))) 

(defvar *cycle-number* Q) 

(defvar *terrain* (make-array ‘(6 7 7 7) :initial-contents (ommitted) 


(defun create-node (h k i j) 
(setf (aref *node-array* h k i j) (make-node))) 


(defun initialize-state (h k 1 }) 
(if (= 1 (aref *terrain* hk 1))) 
(setf (node-state (aref *node-array* h k i j)) ‘obstacle))) 


(defun set-state (heading depth row column state) 
(setf (node-state (aref *node-array* heading depth row column)) state)) 


(defun set-parent (heading depth row column parent) 
(setf (node-parent (aref *node-array* heading depth row column)) parent)) 


(defun set-tendnl-length (heading depth row column length) 
(setf (node-tendril-length (aref *node-array* heading depth row column)) length)) 


(defun set-link-list (heading depth row column list) 
(setf (node-link-list (aref *node-array* heading depth row column)) list)) 


(defun state (heading depth row column) 
(node-state (aref *node-array* heading depth row column))) 


(defun parent (heading depth row column) 
(node-parent (aref *node-array* heading depth row column))) 


(defun tendril-length (heading depth row column) 
(node-tendril-length (aref *node-array* heading depth row column))) 


(defun link-list (heading depth row column) 
(node-link-list (aref *node-array* heading depth row column))) 
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(defun make-terrain (heading-size depth-size row-size column-size) 
(dotimes (h heading-size ‘terrain-initialized) 

(dotimes (k depth-size) 

(dotimes (i row-size) 

(dotimes (j column-size) 

(create-node h k 1)) 

(initialize-state h k 1j)))))) 


(defun legal-fwd-connected-link-list (heading depth row column) 

(non-nil-cons (4-link heading depth (1- row) column) 

(non-nil-cons (diag-link-ul 2 depth (1- row) (1- column)) 

(non-nil-cons (diag-link-ur 4 depth (1- row) (1+ column)) 

(non-nil-cons (diag-up-link-ul 2 (1- depth) (1- row) (1- column)) 

(non-nil-cons (diag-up-link-u heading (1- depth) (1- row) column) 

(non-nil-cons (diag-up-link-ur 4 (1- depth) (1- row) (1+ column)) 

(non-nil-cons (diag-down-link-ul 2 (1+ depth) (1- row) (1- column)) 
(non-nil-cons (diag-down-link-] heading (1+ depth) (1- row) column) 
(non-nil-cons (diag-down-link-ur 4 (1+ depth) (1- row) (1+ column)) nil)))))))))) 


(defun legal-left-connected-link-list (heading depth row column) 

(non-nil-cons (4-link heading depth row (1- column)) 

(non-nil-cons (diag-link-ul 1 depth (1- row) (1- column)) 

(non-nil-cons (diag-link-ll 3 depth (1+ row) (1- column)) 

(non-nil-cons (diag-up-link-ul 1 (1- depth) (1- row) (1- column)) 

(non-nil-cons (diag-up-link-] heading (1- depth) row (1- column)) 

(non-nil-cons (diag-up-link-ll 3 (1- depth) (1+ row) (1- column)) 

(non-nil-cons (diag-down-link-ul 1 (1+ depth) (1- row) (1- column)) 
(non-nil-cons (diag-down-link-] heading (1+ depth) row (1- column)) 
(non-nil-cons (diag-down-link-ll 3 (1+ depth) (1+ row) (1- column)) nil)))))))))) 


(defun legal-back-connected-link-list (heading depth row column) 

(non-nil-cons (4-link heading depth (1+ row) column) 

(non-nil-cons (diag-link-Il 2 depth (1+ row) (1- column)) 

(non-nil-cons (diag-link-Ir 4 depth (1+ row) (1+ column)) 

(non-nil-cons (diag-up-link-ll 2 (1- depth) (1+ row) (1- column)) 

(non-nil-cons (diag-up-link-d heading (1- depth) (1+ row) column) 
(non-nil-cons (diag-up-link-Ir 4 (1- depth) (1+ row) (1+ column)) 

(non-nil-cons (diag-down-link-ll 2 (1+ depth) (1+ row) (1- column)) 
(non-nil-cons (diag-down-link-d heading (1+ depth) (1+ row) column) 
(non-nil-cons (diag-down-link-Ir 4 (1+ depth) (1+ row) (1+ column)) nil)))))))))) 


(defun legal-nght-connected-link-list (heading depth row column) 
(non-nil-cons (4-link heading depth row (1+ column)) 
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(non-nil-cons (diag-link-lr 3 depth (1+ row) (1+ column)) 

(non-nil-cons (diag-link-ur 1 depth (1- row) (1+ column)) 

(non-nil-cons (diag-up-link-ir 3 (1- depth) (1+ row) (1+ column)) 

(non-nil-cons (diag-up-link-r heading (1- depth) row (1+ column)) 

(non-nil-cons (diag-up-link-ur 1 (1- depth) (1- row) (1+ column)) 

(non-nil-cons (diag-down-link-Ir 3 (1+ depth) (1+ row) (1+ column)) 
(non-nil-cons (diag-down-link-r heading (1+ depth) row (1+ column)) 
(non-nil-cons (diag-down-link-ur 1 (1+ depth) (1- row) (1+ column)) nil)))))))))) 


(defun 4-link (heading depth row column) 
(if (not (equal (state heading depth row column) ‘obstacle)) 
(list (list heading depth row column) 2))) 


(defun diag-link-ul (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading depth row (1+ column)) ‘obstacle)) 
(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-link-ll (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading depth (1- row) column) ‘obstacle)) 
(not (equal (state heading depth row (1+ column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-link-ir (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading depth (1- row) column) ‘obstacle)) 
(not (equal (state heading depth row (1- column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-link-ur (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading depth row (1- column)) ‘obstacle)) 
(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-up-link-ul (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) (1+ column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 
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(defun diag-up-link-1 (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1+ column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-up-link-ll (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1+ column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-up-link-d (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) column) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-up-link-lr (heading depth row column) 

(if (and (not (equal (state heading depth row column) “‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1- column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-up-link-r (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1- column)) ‘obstacle)))) 
(list (ist heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-up-link-ur (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) (1- column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-up-link-u (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1+ depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 
(list (ist heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-ul (heading depth row column) 


(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) (1+ column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-] (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1+ column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-ll (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1+ column)) “obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-d (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) column) ‘obstacle)))) 
(list (ist heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-Ir (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1- row) (1- column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-r (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth row (1- column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-ur (heading depth row column) 

(if (and (not (equal (state heading depth row column) ‘obstacle)) 
(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) (1- column)) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun diag-down-link-u (heading depth row column) 
(if (and (not (equal (state heading depth row column) ‘obstacle)) 
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(or (not (equal (state heading (1- depth) row column) ‘obstacle)) 
(not (equal (state heading depth (1+ row) column) ‘obstacle)))) 
(list (list heading depth row column) (* 2 (sqrt 2))))) 


(defun non-nil-cons (item list) 
(if (null item) list (cons item list))) 


(defun initialize-heading-connected-map (heading-size depth-size row-size column-size) 
(make-terrain heading-size depth-size row-size column-size) 
(dotimes (h (- heading-size 2)) 

(dotimes (k (- heading-size 2)) 

(dotimes (1 (- row-size 2)) 

(dotimes (j (- column-size 2)) 

(set-tendril-length (1+ h) (1+ k) (1+1) (1+ j) 0) 

(if (= (1+ h) 1) 

(set-link-list (1+ h) (1+ k) (1+ i) (1+ j) 
(legal-fwd-connected-link-list (1+ h) (1+ k) (1+ 1) (1+ J)))) 
Gf (= (1+ h) 2) 

(set-link-list (1+ h) (1+ k) (1+ i) (1+ j) 
(legal-left-connected-link-list (1+ h) (1+ k) (1+ 1) (1+ )))) 
(if (= (1+ h) 3) 

(set-link-list (1+ h) (1+ k) (1+ 1) (1+ 9) 
(legal-back-connected-link-list (1+ h) (1+ k) (1+ 1) (1+ j)))) 
(if (= (1+ h) 4) 

(set-link-list (1+ h) (1+ k) (1+ 1) (1+) 
(legal-right-connected-link-list (1+ h) (1+ k) (1+ 1) (1+ j))))))))) 


(defun update-root-node (heading depth row column new-tendril-length new-link-list) 
(set-tendril-length heading depth row column new-tendril-length) 
(set-link-list heading depth row column new-link-list)) 


(defun activate-end-node (root node residue) 

(if (equal node *goal*) (setf *goal-flag* t)) 

(set-state (first node) (second node) (third node) (fourth node) *cycle-number*) 
(set-parent (first node) (second node) (third node) (fourth node) root) 
(set-tendnl-length (first node) (second node) (third node) (fourth node) residue) 
(setf *new-active-node-list* (cons node *new-active-node-list*))) 


(defun verify-parent (root node residue) 

(when (> residue (tendril-length (first node) (second node) (third node) (fourth node))) 
(set-parent (first node) (second node) (third node) (fourth node) root) 
(set-tendril-length (first node) (second node) (third node) (fourth node) residue))) 
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(defun test-link (root link tendril-length) 

(let ((residue (- tendril-length (second link))) 

(end-node-state (state (first (first link)) (second (first link)) (third (first link)) (fourth (first 
link))))) 

(cond ((and (null end-node-state) (>= residue 0)) 

(activate-end-node root (first link) residue) nil) 

((and (numberp end-node-state) (= *cycle-number* end-node-state) 

(>= residue 0)) 

(verify-parent root (first link) residue) nil) 

((null end-node-state) link)))) 


(defun grow-tendrils (root tendril-increment) 
(let* ((heading (first root)) (depth (second root)) (row (third root)) (column (fourth root)) 
(new-tendril-length (+ tendnl-increment (tendnl-length heading depth row column))) 
(new-link-list nil)) 
(dolist (link (link-list heading depth row column) 
(update-root-node heading depth row column new-tendril-length new-link-list)) 
(setf new-link-list (non-nil-cons (test-link root link new-tendril-length) 
new-link-list))))) 


(defun increment-wavefront (tendnl-increment) ;returned value not used 
(dolist (root *active-node-list* *new-active-node-list*) 

(setf *new-active-node-list* 

(non-nil-cons (test-root root tendril-increment) *new-active-node-list* )))) 


(defun test-root (root tendril-increment) ;returns root if any tendrils alive 
(if (grow-tendrils root tendril-increment) root)) 


(defun find-path (start goal tendril-increment) 
(initialize-heading-connected-map 6 7 7 7) 

(set-State (first start) (second start) (third start) (fourth start) 0) 
(setf *goal* goal *cycle-number* 0 *active-node-list* (list start) 
*goal-flag* nil) 

(loop (if (or (null *active-node-list*) (not (null *goal-flag*))) 
(return (if (not (null *goal-flag*)) (pprint (path-to-goal goal))))) 
(setf *new-active-node-list* nil) 

(setf *cycle-number* (1+ *cycle-number*)) 

(setf *active-node-list* (increment-wavefront tendril-increment)))) 


(defun path-to-goal (goal) 


(let ((parent (parent (first goal) (second goal) (third goal) (fourth goal)))) 
(if parent (cons goal (path-to-goal parent))))) 
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APPENDIX D (part 1) 
Table 1: Data Dictionary for the Tendril Search 


TYPE 
VARIABLE 
GLOBALS 
DATA_FILE FILE_TYPE 
PATH_FILE 


LOC_ARRAY array (1..4) of INT_TYPE 


LIST record {LOC : LOC_ARRAY 
INC : INT_TYPE 
NEXT : LIST_PTR} 


record {STATE : INT_TYPE 
PARENT : LOC_ARRAY 
TEND_LEN : INT_TYPE} 






PACKAGE 














NODE 










NODE_ARRAY array (INT_TYPE range <, 
INT_TYPE range <, 
INT_TYPE range <, 


INT_TYPE range <>) of NODE 










START_TIME TIME 
END_TIME 
T_TIME DURATION 


MAX_ROW INT_TYPE 
MAX_COL 

MAX_DEP 

MAX_HDG 

DIAG_COST := 99 

CARD_COST := 70 
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Table 1: Data Dictionary for the Tendril Search 


PACKAGE 
PROCEDURE TYPE 
VARIABLE 


WAVE LIST_PTR := null 
NEW_WAVE 

NW_TAIL 

LAST_NEW_WAVE 

WAVE_HEAD 

WAVE_ TAIL 

THE_PATH 

THE_PATH_CURRENT 

TRASH 


START LOC_ARRAY 
GOAL 


GOAL_FOUND BOOLEAN := FALSE 


STRING (1..12) 


NAME_LEN INT_TYPE 


P PATH 

F MOVES 
wre -romsei 
F PATH 


DO SEARCH 














N_ARRAY NODE_ARRAY (1..MAX_ROW, 


1..MAX_COL, 
1..MAX_DEP, 
1..MAX_HDG) 





Table 1; Data Dictionary for the Tendril Search 


TYPE 
VARIABLE 
THE_MOVE 
CK STATE 
NEW_ELE LIST_PTR 


CHECK NODE 







PACKAGE 










LOC_ARRAY := ROOT.LOC 
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DATA FLOW DIAGRAM for the TENDRIL SEARCH (part 2) 





NEW_LOC 
N_ARRAY 
COST 
ROOT 
N_ARRAY 
ELE 


NEW_ELE 
ARRAY ROOT 


N 
ROOT 
ea ELE 
NEW_WAVE 


NW_TAIL 
G 
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TENDRIL SEARCH CODE (part 3) 


—--NAME are DONS 1 OnOme smi. 

--DATE 222 Jan, 19ot 

--REVISED 

Sisk : TENDRIL.ADA 

--DESCRIPTION : Main procedure for the Tendril search 
==CALLS : GET DATA and DO SEARCH in the PATH package 
=--NOTES 


with TEXT_I0, GLOBALS, PATH; 
use TEXT_IO, GLOBALS, PATH; 


procedure TENDRIL is 
begin 
GET DATA; 


DO SEARCH; 
end TENDRIL; 
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~-NAME * (Je “Bonsignore, Jr. 


~-DATE eee san eet oo) 

~~REVISED 

--TITLE : GLOBALS.ADS 

--DESCRIPTION : Global variables for the searches 
=-CALLS 

NOLES 


cc cr cr ce cc cr cr rr rc crm cr ee ee ee 
ce cmc cc ce cre ce cr cre cre cr cr er re cr cr rr err ec me cr cr cr crs ee ee ee eee eee eee ee eee 


with TEXT IO, CALENDAR; 
use TEXT IO, CALENDAR; 


package GLOBALS is 


subtype INT TYPE is INTEGER; 

package INT IO is new INTEGER_IO (INT_TYPE); 
package FLOATIO is new FLOAT IO (FLOAT) ; 

use INT 10, FLOATIO; 


type LOC ARRAY is array (1..4) of INT TYPE; 


type LIST; 
EyPe (blot kik bS access LIST; 
type LIST is 
record 
LOC : LOC ARRAY: 
PNG: SENT TYEE 
NEXT.) BlStaelR; 
end record; 


(others => Q); 
0; 


type NODE; 
type NODE PTR is access NODE; 
type NODE is 
record 
STATE EN en PE p= Oe 
PARENT : LOC ARRAY (others => 0); 
TEND LEN : INT TYPE U; 
end record; 


type NODE_ARRAY is array (INT_TYPE range <>, INT TYPE range 
<>, INT TYPE range <>, INT TYPE 
range <>) of NODE; 
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DATA PILE 9). ba cE EE, 
PATH &£ILE: § PELE ees 


START TIME : TIME; 


END TIME >: TIME; 

Ty EME, : DURATION; 

MAX ROW wT EVE, 

MAX COL : INE STYEE 

MAX DEP UN T Sve Ey, 

MAX HDG * aN Eee, 

DIAG GOS TS >: SiN ii Yer 99; 

CARD COST EN ie 70. 

WAVE 7 ES Roe thea Milas 
NEW WAVE Se ICS I Sih). 2 null; 
NwW_TAIL SES IEMs 6 = null; 


LAST NEW WAVE : LIST PTR := null; 


WAVE _HEAD : LIST PTR := null; 
WAVE TAIL : LIST PTR := null; 
THE PATH : LIST PTR := null; 


THE PATH CURRENT : LIST PTR ;:= null; 
TRASH ; LIST PTR := null; 


START : LOC_ARRAY; 
GOAL : LOC ARRAY; 


GOAL FOUND : BOOLEAN := FALSE; 


end GLOBALS; 


qe em ee crm cm ms crs me cs sm ee ce cm ce ce a ee cm cr crs a re rs cms ee mr cr crm we cs ce crm me ce ec ws cr cr ee ee es = 
ee Oc re cc cr ce me cm cr cr cr ecm cre rr rr cr ee crm ee ce ce cc er cc crm cc cc ec ee ee ee 


J. Bonsignore, Jr. 
22 Jan, 1991 
=-REVISED 
a= 1 L TLE 
=-DMOCRLe T FON 


PATH.ADS 


oe oe ee ee ee oe oe ee 


<r cee cee ce cee cee ce ce ce ce ce crm com cm me cc cm crm cr cr cs ce ce ce cm ce cc ce ce cm cm cr re ce ce cm cc ce cm ee ce ee ee eee ee 
ee ce ee mcm cm crm cm cre ce crm ec crm rr cs cr cm ec cr crm ee ce cc cr cr cc cc co ce cc cr cr ec co cr ec ee ee ee ee ee 


with TEXT IO, GLOBALS, THE MOVE, 
UNCHECKED DEALLOCATION, CALENDAR; 
use TEXT IO, GLOBALS, THE MOVE, CALENDAR; 
package PATH is 
procedure DO SEARCH; 
Procedure GET) DATA; 
procedure READ TER (N_ ARRAY : in out NODE ARRAY) ; 


procedure P_ PATH (N ARRAY : in out NODE ARRAY) ; 


end PATH; 


--NAME >: J. Bonsignore, Jr. 
--DATE wees Jat pr lool 

=—nREV LSED : 

oot LE : PATH.ADB 
s=OUboCKIPTION 


co os os cs cs ws os cs cs cs cs ws cs cs ws ws es cs cs cs cs os cos cs cs cs cs co co co cr we crm cr cis cc es ee ce ce ce ce ce ce ee ee ee ee ee ee ee ee 
SS ee _,...........__..___.._ 


package body PATH is 
procedure GET DATA is 


FILE NAME : STRING (1..12); 
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NAME LEN : INT TYPE; 


begin 
put ("Enter the name of data file: "); 
get line (FILE NAME, NAME _LEN) ; 
FILE NAME ((NAME LEN + 1)..12) := (others => ' '); 
FILE NAME (9..12) := ".DAT"; 


OPEN (DATA FILE, MODE => IN FILE, NAME => FILE NAME); 
INT I0.get (DATA FILE, MAX_ROW); 
INT IO.get (DATA_FILE, MAX COL); 
INT IO0.get (DATA_FILE, MAX DEP); 
INT I0.get (DATA FILE, MAX_HDG); 


NEW LINE; 

put ("Enter the starting row: "); 
INT IO.get (START(1)); 

NEW LINE; 

put ("Enter the starting col: "); 
INT I10.get (START (2)); 

NEW LINE; 

put ("Enter the starting dep: "); 
INT I0.get (START (3)); 

NEW LINE; 

put ("Enter the starting hdg: "); 
INT I0.get (START (4)); 

NEW LINE; 

put ("Enter the goal row: "); 

INT I0.get (GOAL(1)); 

NEW LINE; 

put ("Enter the goal col: "); 

INT I0.get (GOAL(2)); 

NEW LINE; 

put ("Enter the goal dep: "); 

INT I0.get (GOAL(3)); 

NEW LINE; 

put ("Enter the goal hdg: "); 

INT I0.get (GOAL(4)); 

WAVE ;:= new LIST; 

WAVE.LOC := START; 


WAVE.INC := 0; 
end GET DATA; 


procedure READ TER (N ARRAY : in out NODE ARRAY) is 
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begin 
for ROW in 1..MAX ROW loop 
for COL in 1..MAX COL loop 
for DEP in 1..MAX DEP loop 
for HDG in 1..MAX HDG loop 


INT IO.get (DATA FILE, N_ ARRAY (ROW, COL, 
DEP, HDG) .STATE) ; 
N ARRAY (ROW, COL, DEP, HDG).TEND LEN := 0; 
N ARRAY (ROW, COL, DEP, HDG) .PARENT := 


OFS OFM Ol er 
end loop; 
end loop; 
end. 1100p; 
end loop; 
close ADATA FILE); 
end READ TER; 


procedure P PATH (N ARRAY : in out NODE ARRAY) is 


NEXT _LOC LOC_ARRAY; 
PATH FILE : FILE TYPE; 
begin 


if GOAL FOUND then 
CREATE (PATH FILE, NAME => "path.file"); 


put ('('); 

INT IO.put (GOAL(1)); 

INT 1O.put (GOAL (2)); 

INT 10.put (GOAL(3)); 

INT IO.put (GOAL(4)); 

DUE. €')°*)> 

INDO. pute (PATH FILE, GOAL (1)); 
INT IO.put (PATH FILE, GOAL(2)); 
ant TO. pur (PATA RIE, GOAL (3) ); 
INT IO.put (PATH FILE, GOAL(4)); 


new line; 


new line (PATH FILE); 
NEXT LOC := N_ ARRAY (GOAL(1), GOAL(2), GOAL(3), 
GOAL (4) ) .PARENT; 

while NEXT LOC /= START loop 


Puc." (jy 
INT IO.put (NEXT LOC(1)); 
INT IO.put (NEXT LOC(2)); 
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INT 10.put 
INT IO.put 
put (')"); 
INT SLOeeue 
INT IO.put 
INT IO.put 
INT I0O.put 


(NEXT LOC (3) ); 
(NEXT LOC (4) ); 


(PATH FILE, 
(PATH FILE, 
(PATH FILE, 
(PATH FILE, 


NEXT LOC(1)); 
NEXT LOC(2)); 
NEXT LOC (3)); 
NEXT LOC (4)); 


NEXT LOC := N_ARRAY(NEXT_LOC(1), NEXT_LOC(2), 
NEXT _ LOC (3),NEXT_ LOC (4) ) .PARENT; 
NEW LINE; 
new line (PATH_FILE) ; 
end loop; 
put ('('); 
INT IO.put 
INT IO.put 


INT IO.put 


(START (1) ); 
(START (2) ); 
(START (3) ); 


INT IO.put 
puts (") 7); 
INT 1I0O.put 
INT IQ.put 
INT IO.put 
INT IO.put 


(START (4) ); 


(PATH FILE, 
(PATH FILE, 
(PATH FILE, 
(PATH FILE, 


START (1) ); 
START (2) ); 
START (3)); 
START (4) ); 


new_ line; 
new_l ine (PATH REALE es 
INT IO.put (N ARRAY (GOAL(1), GOAL(2), GOAL(3), 
GOAL (4)) .TEND_ LEN) ; 

new_line; 
CLOSE (PATH FILE); 

else 
put ("PATH NOT FOUND”); 
new line; 

end. 17 5 

eng geese ATH, 


procedure F MOVES (N ARRAY : 
ROOT 


in out NODE ARRAY; 
; in Out LYStaeiRyeas 
HEADING ‘ Ni YP := ROOT.LOC (4); 
begin 

case HEADING is 


when 1 => 
CHECK UP_NW (N ARRAY, ROOT); 
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CHECK _UP_N (N ARRAY, ROOT); 
CHECK UP_NE (N_ARRAY, ROOT); 
CHECK NW (N ARRAY, ROOT); 
CHECK N (N ARRAY, ROOT); 
CHECK NE (N ARRAY, ROOT) ; 
CHECK DOWN NW (N ARRAY, ROOT); 
CHECK DOWN _N (N ARRAY, ROOT); 
CHECK _DOWN_NE (N_ ARRAY, ROOT); 


when 2 => 
CHECK UP_NE (N ARRAY, ROOT); 
CHECK UP _E (N ARRAY, ROOT); 
CHECK UP_SE (N ARRAY, ROOT); 
CHECK _NE (N ARRAY, ROOT); 
CHECK E (N ARRAY, ROOT); 
CHECK SE (N ARRAY, ROOT) ; 
CHECK DOWN _NE (N_ ARRAY, ROOT) ; 
CHECK DOWN_E (N ARRAY, ROOT); 
CHECK DOWN SE (N ARRAY, ROOT); 


when 3 => 

CHECK UP_SE (N ARRAY, ROOT); 
CHECK UP _S (N ARRAY, ROOT); 
CHECK UP SW (N ARRAY, ROOT); 
CHECK SE (N ARRAY, ROOT); 
CHECK S (N ARRAY, ROOT); 
CHECK SW (N ARRAY, ROOT); 
CHECK DOWN SE (N_ ARRAY, ROOT); 
CHECK DOWN S (N ARRAY, ROOT); 
CHECK_DOWN_SW (N_ARRAY, ROOT) ; 


when 4 => 
CHECK UP_SW (N ARRAY, ROOT) ; 
CHECK UP_W (N ARRAY, ROOT); 
CHECK UP_NW (N ARRAY, ROOT) ; 
CHECK SW (N ARRAY, ROOT); 
CHECK W (N ARRAY, ROOT) ; 
CHECK NW (N ARRAY, ROOT); 
CHECK DOWN SW (N ARRAY, ROOT) ; 
CHECK DOWN _W (N ARRAY, ROOT); 
CHECK DOWN_NW (N ARRAY, ROOT); 


when others => 
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nah: 


end case; 
end F MOVES; 


procedure FREE is new UNCHECKED DEALLOCATION (LIST, 
LIST PTR); 
procedure F PATH (N_ARRAY : in out NODE ARRAY) is 
ROOT: EISTIPTIR = WAVE, 
begin 


while ROOT /= null loop 
F MOVES (N_ARRAY, ROOT); 


ROOT := WAVE.NEXT; 
FREE (WAVE) ; 
WAVE := ROOT; 


end loop; 

if GOAL FOUND then 
return; 

end if; 

WAVE := NEW WAVE; 

NEW WAVE := null; 

LAST NEW WAVE := null; 

end BE Ese, 


procedure DO SEARCH is 


N ARRAY : NODE ARRAY (1..MAX ROW, 1..MAX COL, 
1..MAX DEP, 1..MAX HDG); 


begin 
START TIME := CLOCK; 
READ TER (N ARRAY) ; 
while WAVE /= null loop 
F PATH (N_ARRAY) ; 
exit when GOAL FOUND; 
end loop; 
P PATH (N ARRAY); 
END TIME := CLOCK; 
T TIME := END TIME - START TIME; 


NEW LINE; 

PLOATIO. put. (FLOAT (T TIME) ); 

put (" seconds of cpu time."); 
end DO SEARCH; 


end PATH; 
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--NAME ;: J. Bonsignore mum. 

——-DALE : 22 Janel ool 

==REV ISED : 

==TIIGE >: THE MOVE.ADS 

--DESCRIPTION : Contains the procedures for checking and 
== >: processing individual 

= ; modes sent from F MOVES. 

==CALLS ; 

=—=NOTES : 


with TEXT IO, GLOBALS; 
use TEXT IO, GLOBALS; 


package THE MOVE is 


procedure NNC (ELEMENT : in LIST PTR; 
HEAD : in out LIST PTR; 
TAIL o ImMAoue ETSeee TR), 


procedure GROW TEND (ELE lat Colbhe Jb GSe SUL 
N ARRAY : in out NODE ARRAY; 
ROOT ; 2m OuG LIST PIR): 


procedure CK STATE (NEW LOC : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY; 
NEW INC in) outs PN vey, 

ROOT eg ethene SIU EIS) 


procedure CHECK _N (N_ARRAY : in out NODE ARRAY; 
ROOT ; in Out) Eiodee 1R).; 


procedure CHECK_UP_N (N ARRAY : in out NODE ARRAY; 
ROOT hour ine Jemtlse)) S 


procedure CHECK DOWN_N' (N_ARRAY : in out NODE ARRAY; 
ROOT repel geisha ILS y EMSS) F 


procedure CHECK _NE (N ARRAY : in out NODE ARRAY; 
ROOT 2 Dn Our ron genre: 


procedure CHECK UP_NE (N_ ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR); 
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procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


CHECK DOWN NE (N ARRAY : in out NODE ARRAY; 


ROOT = i, Out rsh ZP IR) ; 


CHECK E (N ARRAY : in out NODE ARRAY; 


ROOT = Ine Cut List se ER) ; 


CHECK UP E (N ARRAY : in out NODE ARRAY; 


ROOT iin out LIST BTR); 


CHECK DOWN E (N ARRAY : in out NODE ARRAY; 


ROOT SNS Our Si lon 2 LR): 


CHECK SE (N ARRAY : in out NODE ARRAY; 


ROOT eee GUC LIST yet); 


CHECK UP_SE (N_ARRAY : in out NODE ARRAY; 


ROOT lt Outs Uist BER); 


CHECK DOWN SE (N ARRAY : in out NODE ARRAY; 


ROOT env OUE= fl Str Lye, 


CHECK S (N ARRAY : in out NODE ARRAY; 


ROOT : in out LIST PTR); 


CHECK _UP_S (N ARRAY : in out NODE ARRAY; 


ROOT 2 rinwoue Llot PTR) ; 


CHECK_DOWN S (N ARRAY : in out NODE ARRAY; 


ROOT : in out LIST PTR); 


CHECK SW (N_ ARRAY : in out NODE ARRAY; 


ROOT ein -OUGILES Lb TR)y, 


CHECK_UP_SW (N ARRAY : in out NODE ARRAY; 


ROOT oiit Out ol] Jeu), 


CHECK DOWN SW (N_ARRAY : in out NODE ARRAY; 


ROOT SeileOul bho toe PR), 


CHECK W (N ARRAY : in out NODE ARRAY; 


ROOT on OUGwerol PER); 
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procedure CHECK UP W (N ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR); 


procedure CHECK DOWN W (N ARRAY : in out NODE ARRAY; 
ROOT = 2n OU ELST ois 


procedure CHECK NW (N ARRAY : in out NODE ARRAY; 
ROOT Lee Sey ay) & 


procedure CHECK UP_NW (N ARRAY : in out NODE ARRAY; 
ROOT ; in ut LIST PTR 


procedure CHECK DOWN NW (N ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR); 


end THE MOVE; 


ee ee cc cc ce ce ce ce ce ec ee ee i ss 
Soe ee cm crm ee i ge me cmc cc cc cs cs co cs cc ce cs ce cc cs cm cs cc ce cc ce cw cs ss os cs cs es cs ss es ee oe 


--NAME :. J. Bonsignore, Jr. 

--DATE >: 22 Jan, 1991 

--REVISED : 

== 2 lik >; THE MOVE.ADB 

--DESCRIPTION : The package body for THE MOVE 


— eps eg ee ee ee ee ee ee ee ee ce ee ce ee ee ee ee ee ee es ee ee es es es ee es ee es es es es es ee ee ee ee ee ee ee ee oe 


with TEXT IO, GLOBALS; 
use TEXT IO, GLOBALS; 


package body THE MOVE is 


procedure NNC (ELEMENT ~~; angibisteeir: 
HEAD lg) (oruhe Gis Tee ik; 
TAIL ee Out eo tea) is 
-- Creates and performs list maintanence. 
begin 
if HEAD = null then 
HEAD := ELEMENT; 
TAIL := ELEMENT; 
else 
TAIL.NEXT ;:= ELEMENT; 
TAIL := TAIL.NEXT; 
end if; 


end NNC; 


procedure GROW TEND (ELE ; in out LIST PTR; 
N ARRAY : in out NODE ARRAY; 
ROOT eimvoute lio! bun) sas 


Determines if nodes have been previously processed and if 
necessary reassignes. 


ee 


procedure ASSIGN (N_ ARRAY in out NODE ARRAY; 
ELE Woy anne mIbGL SME East 
ROOT INOUE iS T eT Rey Its 


Once a node is determined to be a legal move its 
attributes 
are assigned, and the GOAL is checked for completion. 


begin 
N_ ARRAY (ELE.LOC (1), ELE.LOC(2),ELE.LOC (3), 
ELE.LOC (4) ).PARENT := ROOT.LOC; 
NOARRAY (ELE. LOG (1) BLE sLOC(2),; BERSECE (3), 
ELE.LOC(4)).TEND LEN := ELE.INC + 
N_ ARRAY (ROOT.LOC (1), ROOT.LOC (2) , ROOT. LOC (3), 
ROOT.LOC (4) ) .TEND_ LEN; 
if ELE.LOC = GOAL then 
GOAL FOUND := TRUE; 
end 11: 
NNC (ELE, NEW WAVE, NW TAIL); 
end ASSIGN; 


begin 
if N ARRAY (ELE.LOC(1),ELE.LOC (2) ,ELE.LOC (3), 
ELE.LOC(4)).TEND LEN = 0 then 
ASSIGN (N_ ARRAY, ELE, ROOT); 
elsif N ARRAY (BEE LOG{(1) | ELE. LOG (2), ELE .LOC(3); 
ELE.LOC(4)).TEND LEN > 
(NSARRAY (ROOT: DOC(') 7 ROOT LOC (2) 7; ROOF .EOC(3s), 
ROOT.LOC (4)) .TEND LEN + ELE.INC) then 
ASSIGN (N ARRAY, ELE, ROOT); 
end if; 
end GROW TEND; 


procedure CK STATE (NEW LOC > in out LOC ARRAY; 
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N_ ARRAY >; 1n OURMNODEVARRAY ; 
NEW INC ; 1M OU EN Tee 
ROOT ;: in OUG Liste te is 


Checks if the node is an obstacle. If not it calls the 
GROW_TEND procedure. 


NEW ELE : LIST PTR; 


begin 
if N_ ARRAY (NEW_LOC(1), NEW_LOC(2), NEW _LOC(3), 
NEW _LOC(4)).STATE = 0 then 
NEW ELE := new LIST; 
NEW _ELE.LOC := NEW_LOC; 
NEW ELE.INC := NEW_INC; 
GROW TEND (NEW_ELE, N_ ARRAY, ROOT); 
end if; 
end CK STATE; 


The remaining procedures are for individual "moves." The 
coordinates are calculated and a cost is assigned to the 


move. Each calls CK STATE. 


procedure CHECK_N (N_ARRAY : in out NODE ARRAY; 
ROOT 202 OU E Stee PR) ic 


NEW _ LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_LOC(1) > 1 then 
NEW _LOC(1) := NEW LOC(1) - 1; 
CK STATE (NEW LOC, N_ ARRAY, CARD COST, ROOT); 
end if; 


end CHECK N; 


procedure CHECK _UP_N (N ARRAY : in out NODE ARRAY; 
ROOT ; in out LIST PTR) is 


NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 


IF NEW_LOC(1) > 1 and NEW_LOC(3) > 1 then 
NEW_LOC(1) := NEW_LOC(1) - 1; 


NEWeLOG (3). <= NEWNEOG (3) = 1; 
CK STATE (NEW_LOC, N ARRAY, DIAG COST, ROOT); 
end if; 
end CHECK _UP_N; 


procedure CHECK DOWN_N (N_ARRAY : in out NODE ARRAY; 


ROOT IM OUG LISTIPTR) 1s 
NEW LOC : LOC_ARRAY := ROOT.LOC; 
begin 

IF NEW LOC(1) > 1 and NEW_LOC(3) < MAX DEP then 

NEW LOC(1) := NEW_LOC(1) - 1; 

NEW LOC(3) := NEW_LOC(3) + 1; 

CK STATE (NEW_LOC, N_ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK DOWN_N; 


procedure CHECK _NE (N_ARRAY : in out NODE ARRAY; 
ROOT Sango GOT PLR) els 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 
if NEW _LOC(1) > 1 and NEW_LOC(2) < MAX COL then 
NEW LOC(1) := NEW_LOC(1) - 1; 
NEW LOC(2) := NEW LOC(2) + 1; 
if ROOT.LOC(4) = 1 then 
NEW _LOC (4) := 2; 
else 
NEW_LOC (4) := 1; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK NE; 


procedure CHECK UP_NE (N_ ARRAY : in out NODE ARRAY; 
ROC : “i out Bi STP TR) is 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW _LOC(1) > 1 and NEW _LOC(2) < MAX COL and 
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NEW LOC(3) > 1 then 


NEW _LOC(1) := NEW _LOC(1) - 1; 
NEW LOC(2) := NEW_LOC(2) + 1; 
NEW LOC (3) := NEW_LOC(3) - 1; 
if ROOT.LOC(4) = 1 then 
NEW LOC (4) := 2; 
else 
NEW_LOC(4) := 1; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT) ; 
end if; 


end CHECK _UP_NE; 


procedure CHECK DOWN_NE (N_ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR) 


NEW_LOC : LOC_ARRAY := ROOT.LOC; 


begin 

IF NEW _LOC(1) > 1 and NEW_LOC(2) < MAX COL and 

NEW _LOC(3) < MAX_DEP then 

NEW LOC(1) := NEW_LOC(1) 

NEW LOC(2) := NEW_LOC(2) 
NEW_LOC(3) := NEW_LOC(3) 

if ROOT.LOC(4) = 1 then 
NEW_LOC(4) := 2; 


+ + 
Pee 


™e 


e ‘e 


else 
NEW_LOC (4) := 1; 
end if; 
CK STATE (NEW_LOC, N ARRAY, DIAG COST, ROOT); 
end if; 
end CHECK DOWN_NE; 


procedure CHECK_E (N ARRAY : in out NODE ARRAY; 
ROOT 7 in out Ulster lc 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(2) < MAX COL then 
NEW LOC(2) := NEW LOC(2) + 1; 
CK STATE (NEW_LOC, N ARRAY, CARD COST, ROOT); 
end if; 


end CHECK 5; 


procedure CHECK UP E (N ARRAY : in out NODE ARRAY; 
ROOT 2 roll t Bicd Pikj-eis 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW LOC (2) < MAX COL and NEW LOC(3) > 1 then 


NEW LOC(2) := NEW LOC(2) + 1; 

NEW LOC(3) := NEW LOC(3) - 1; 

CK STATE (NEW_LOC, N_ARRAY, DIAG COST, ROOT); 
end 12; 


end, CHECK UPLE, 


procedure CHECK DOWN_E (N_ARRAY : in out NODE ARRAY; 


ROOT : in out LIST PTR) is 
NEW LOC : LOC ARRAY := ROOT. LOC; 
begin 

IF NEW _LOC(2) < MAX COL and NEW_LOC(3) < MAX DEP 
then 

NEW LOC(2) := NEW LOC(2) + 1; 

NEW LOC (3) := NEW LOC(3) + 1; 

CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK DOWN E; 


procedure CHECK W (N ARRAY : in out NODE ARRAY; 


ROOT we POUCL TST ae TR) eis 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 
IF NEW _LOC(2) > 1 then 
NEW EOC (Z) <= NEW LOC(2) -—— 1; 
CK STATE (NEW_LOC, N ARRAY, CARD COST, ROOT); 
end 12; 


end CHECK W; 


procedure CHECK UP_W (N_ ARRAY : in out NODE ARRAY; 
ROOT 2 aneene EIST PTR): 1s 
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NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(2) > 1 and NEW_LOC(3) > 1 then 
NEW LOC(2) := NEW _LOC(2) - 1; 
NEW LOC(3) := NEW_LOC(3) - 1; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK UP W; 


procedure CHECK DOWN W (N_ ARRAY : in out NODE ARRAY; 
ROOT ; In OUt LEST IP ORi es 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW _LOC(2) > 1 and NEW_LOC(3) < MAX DEP then 
NEW LOC(2) := NEW _LOC(2) - 1; 
NEW LOC(3) := NEW_LOC(3) + 1; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 
end CHECK DOWN W; 


procedure CHECK _S (N ARRAY : in out NODE ARRAY; 
ROOT = inoue GhStee ik) ers 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_LOC(1) < MAX ROW then 
NEW LOC(1) := NEW_LOC(1) + 1; 
CK STATE (NEW LOC, N ARRAY, CARD COST, ROOT); 
end if; 


end CHECK S; 


procedure CHECK_UP_S (N_ ARRAY : in out NODE ARRAY; 
ROOT [oan Ours lor PER) 1s 


NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 


IF NEW_LOC(1) < MAX ROW and NEW _LOC(3) > 1 then 
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NEW LOC (1) = NEW LOC (1) +c 1c 

NEW LOC(3) := NEW LOC(3) - 1; 

CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK_UP_S; 


procedure CHECK DOWN _S (N_ARRAY : in out NODE ARRAY; 


ROOT Sil OUty bio ti) eas 
NEW LOC : LOC_ARRAY := ROOT .LOC; 
begin 

IF NEW LOC(1) < MAX ROW and NEW _LOC(3) < MAX DEP 
then 

NEW LOC(1) := NEW LOC(1) + 1; 

NEW LOC(3) := NEW _LOC(3) + 1; 

CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK_DOWN_S; 


procedure CHECK SE (N ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR) is 


NEW_LOC : LOC_ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(1) < MAX _ROW and NEW _LOC(2) < MAX COL 
then 
NEW LOC(1) := NEW _LOC(1) + 1; 
NEW LOC(2) := NEW LOC(2) + 1; 
if ROOT.LOC(4) = 2 then 
NEW LOC(4) := 3; 
erce 
NEW_LOC (4) := 2; 
end ii; 
CK_STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 
end. CHECK SS; 
procedure CHECK_UP_SE (N_ARRAY : in out NODE ARRAY; 
ROOT SfinlOut Diol se ik) =as 


NEW_LOC : LOC ARRAY := ROOT.LOC; 
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begin 
IF NEW_LOC(1) < MAX_ROW and NEW _LOC(2) < MAX COL 
and NEW LOC(3) > 1 then 


NEW LOC(1) := NEW_LOC(1) + 1; 
NEW LOC(2) := NEW _LOC(2) + 1; 
NEW _LOC(3) := NEW_LOC(3) - 1; 
if ROOT.LOC(4) = 2 then 
NEW_LOC(4) := 3; 
else 
NEW_LOC(4) := 2; 
end if; 
CK STATE (NEW_LOC, N_ ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK UP_SE; 


procedure CHECK DOWN _SE (N_ARRAY  : abel (oybhe NODE ARRAY; 
ROOT : in out LIST PTR) is 
NEW LOC : LOC_ARRAY := ROOT.LOC; 
begin 


IF NEW LOC(1) < MAX _ROW and NEW _LOC(2) < MAX_COL 
and NEW _LOC(3) < MAX_DEP then 


NEW_LOC(1) := NEW_LOC(1) + 1; 
NEW LOC(2) := NEW_LOC(2) + 1; 
NEW LOC(3) := NEW _LOC(3) + 1; 
if ROOT.LOC(4) = 2 then 
NEW LOC(4) := 3; 
else 
NEW_LOC(4) := 2; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK DOWN SE; 


procedure CHECK SW (N_ ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR) is 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 


IF NEW_LOC(1) < MAX_ROW and NEW LOC(2) > 1 then 
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NEW LOC(1) := NEW_LOC(1) + 1; 
NEW LOC(2) := NEW LOC(2) - 1; 
if ROOT.LOC(4) = 3 then 
NEW LOC(4) := 4; 
else 
NEWT LOC(4)0°s= 37 
end if; 
CK STATE (NEW LOC, N_ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK SW; 


procedure CHECK UP_SW (N ARRAY : in out NODE ARRAY; 
ROOT Soh OUCH Ut Ste PIR) as 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 


IF NEW LOC(1) < MAX ROW and NEW _LOC(2) > 1 and 
NEW_LOC(3) > 1 then 


NEW LOC(1) := NEW _LOC(1) + 1; 
NEW LOC(2) := NEW LOC(2) - 1; 
NEW _LOC(3) := NEW_LOC(3) - 1; 
if ROOT.LOC(4) = 3 then 
NEW LOC (4) := 4; 
else 
NEW_LOC(4) := 3; 
end if; 
CK_ STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end iat; 
end CHECK _UP_SW; 
procedure CHECK DOWN SW (N ARRAY : in out NODE ARRAY; 
ROOT ot OU ore rn) ess 
NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW _LOC(1) < MAX ROW and NEW LOC(2) > 1 and 
NEW LOC(3) < MAX DEP then 


NEW LOC(1) := NEW LOC(1) + 1; 
NEW LOC(2) := NEW LOC(2) - 1; 
NEW LOC(3) := NEW LOC(3) + 1; 
if ROOT.LOC(4) = 3 then 


18) 


NEW LOC(4) := 4; 


else 
NEW LOC(4) := 3; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end. 22: 


end CHECK DOWN_ SW; 


procedure CHECK NW (N_ ARRAY  : Lavoute NODE _ ARRAY; 
ROOT > ih out LIST PeGR) is 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 
IF NEW LOC(1) > 1 and NEW _LOC(2) > 1 then 
NEW LOC(1) := NEW_LOC(1) - 1; 
NEW LOC(2) := NEW_LOC(2) - 1; 
if ROOT.LOC(4) = 1 then 
NEW LOC(4) := 4; 
else 
NEW LOC(4) := 1; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK NW; 


procedure CHECK_UP_NW (N ARRAY : in out NODE _ ARRAY; 
ROOT ; AN VOUbEi oT ee TR) as 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(1) > 1 and NEW _LOC(2) > 1 and NEW LOC (3) 
> 1 then 
NEW LOC(1) := NEW _LOC(1) - 1; 
NEW LOC (2) := NEW _LOC(2) - 1; 
NEW _LOC(3) := NEW LOC(3) - 1; 
if ROOT.LOC(4) = 1 then 
NEW LOC(4) := 4; 
else 
NEW LOC(4) := 1; 
end if; 


CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
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end if; 
end CHECK UP_NW; 


procedure CHECK DOWN NW (N_ARRAY : in out NODE ARRAY; 
ROOT ; 1, Out List PLR} as 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 
IF NEW LOC(1) > 1 and NEW_LOC(2) > 1 and NEW _LOC (3) 
< 
MAX DEP then 
NEW LOC(1) := NEW_LOC(1) - 1; 
NEW _LOC(2) := NEW_LOC(2) - 1; 
NEW LOC(3) := NEW _LOC(3) + 1; 
iienOOt 60C(4), — "1 then 
NEW LOC (4) := 4; 
else 
NEW _LOC(4) := 1; 
end “if, 
CK_ STATE (NEW _LOC, N_ARRAY, DIAG COST, ROOT); 
end <1£; 


end CHECK DOWN NW; 


end THE MOVE; 
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APPENDIX E (part 1) 








PACKAGE 
PR DURE 
VARIABLE 










Table 1: Data Dictionary for the TENDRILWP Search 
PATHWP 
GET DATA 


FILE_NAME STRING (1..12) 


oe CHARACTER = 


— 
F MOVES 

wee nonce 
F PATH 

a 


DO_SEARCH 

N_ARRAY NODE_ARRAY (1..MAX_ROW, 
1..MAX_COL, ‘ 
1..MAX_DEP, 
1. MAX_HDG) 
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DATA FLOW DIAGRAM for the TENDRILWP SEARCH (part 2) 





NEW_LOC 
N Y 
COST 
ROOT 
NEM a 
ROOT ROOT 
we ELE 
NEW_WAVE 


NW_TAIL 
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TENDRILWP SEARCH CODE (part 3) 


ccc cm cc cc ec cr cc cr cr cr cr cr cr cr ce cc ce ce cc cc cc cc cr ce ee es ee ee 
a ce cc cc ec ce cc cc cc cr cc ec cs cs cc ce cs rc ce ce cc ce ce ce cs ce ce ce ce cr ce es ss es es es es ee oe 


--NAME : oJ. Bonsignore, Jr. 

--DATE : (22 Jan joo 

--REVISED 

==T TITLE : TENDRILWP.ADA 

--DESCRIPTION : Main procedure for the Tendril search with 
waypoints. 

--CALLS SOP wATA; and DO SEARCH in the PATHWP package 
=<NOLEo 


eee ce ce ce ce ce ce ce ce crc ce cr ce ce ce cr cr cr cr cr cs ee re ce ce cc oe ce co cc ce cs ce ee ee es we ws we ss ee 
—_— = La eee ae a = a cc cc ee cc ce ce ce ce ce ce ee ee ee ee ee ee eee ee ee ee ee ee 


with TEXT IO, GLOBALS, PATHWP; 
use TEXT IO, GLOBALS, PATHWP; 


procedure TENDRILWP is 
begin 
GET DATA; 


DO SEARCH; 
end TENDRILWP; 
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--NAME oe EONSTOnOre,. JE. 


--DATE pee, Oana oo 1 
~-REVISED : 
=—TITLE : PATHWP .ADS 


--~DESCRIPTION : Contains the major procedures for the Tendril 
With waypoint 
= >: search 


with TEXT IO, GLOBALS, THE MOVE, UNCHECKED DEALLOCATION; 
use TEXT IO, GLOBALS, THE MOVE; 


package PATHWP is 
procedure DO SEARCH; 
precedure GET DATA; 
procedure READ TER (N ARRAY : in out NODE ARRAY) ; 
procedure P_PATH (N ARRAY : in out NODE ARRAY); 


end PATHWP; 


--NAME S “i BONS rGnoOre dr 

-~DATE s---22-Jdan,- 1991 

--REVISED ; 

salt TLE >: PATHWP.ADB 

--DESCRIPTION : Package body for PATHWP package 

--NOTES : Differences from PATH package: GET DATA 

a >: makes a 

=< ; ilist of waypoints, P PATH creates a list of 
he >: records in each path segment and writes to 
—— oS trle only 2{mo .Screen Ouepur);) RESET ALL 

a ; resets global variables to initial settings 
-- : after each path segment is completed. 


package body PATHWP is 
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procedure GET DATA is 


-- Opens the terrain data file, reads in the array dimensions 
-- and takes the starting and goal coordinates as input. 


FILE NAME : STRING (1..12); 


NAME LEN : INT_TYPE; 
CONT : CHARACTER ;— '¥, 

begin 
put ("Enter the name of data file: "); 
get line (FILE NAME, NAME LEN); 
FILE NAME ( (NAME LEN + 1)..12) := (others => ' '); 
FILE NAME (9..12) := ".DAT"; 


OPEN (DATA FILE, MODE => IN FILE, NAME => FILE NAMB); 
INT I0.get (DATA_FILE, MAX ROW); 
INT IO.get (DATA FILE, MAX COL); 
INT IO0.get (DATA FILE, MAX DEP); 
INT IO0.get (DATA FILE, MAX HDG); 


NEW LINE; 
WAVE HEAD := new LIST; 
WAVE TAIL := WAVE HEAD; 
while CONT = ‘'y' or CONT = 'Y' loop 
put ("Enter the position row: "); 
INT I0.get (WAVE TAIL.LOC(1)); 
NEW LINE; 
put ("Enter the position col: "); 
INT IO0.get (WAVE TAIL.LOC(2)); 
NEW LINE; 
put ("Enter the position dep- ==.) 
INT I10.get (WAVE TAIL.LOC(3)); 
NEW LINE; 
put ("Enter the position hdg ia) ; 
INT IO0.get (WAVE TAIL.LOC(4)); 
NEW LINE; 


put ("Enter another position?"); 
get (CONT); 
1f CONT = ‘'y' or CONT = 'Y' then 
WAVE TAIL.NEXT := new LIST; 
WAVE TAIL := WAVE TAIL.NEXT; 
end if; 
end loop; 
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end GET DATA; 


procedure READ TER (N_ARRAY : in out NODE ARRAY) is 


-- Reads the terrain data from the data file and initializes 


-- the N ARRAY. 


begin 
for ROW in 1..MAX ROW loop 
fOr CObfin. 1s Max COL 1oep 
fOr DEP a7 1. .MAX DEP loop 
for HDG in 1..MAX HDG loop 


INT IO.get (DATA_FILE, N_ARRAY (ROW, COL, DEP, 


HDG) . SPATE); 


N ARRAY (ROW, COL, DEEL, HDG) .TEND LEN = 0; 
N ARRAY (ROW, COL, DEP, HDG) .PARENT 
(0; OF OF 8 
end loop; 
end loop; 
end loop; 
end loop; 
close (DATA FILE) ; 
end READ TER; 
procedure PF PATH (N-UARRAY |: im Out NODE ARRAY) is 
Bempcmeaces da 1iSt, THESPATH wand Writes 10) to a file. 
NEXT LOC : LOC ARRAY; 
begin 
if GOAL FOUND and THE PATH = null then 
THE PATH := new LIST; 
THE PATH.LOC := GOAL; 
loop 
NEXT LOC := N_ARRAY(GOAL(1), GOAL(2), GOAL(3), 
GOAL (4) ) .PARENT; 
THE PATH CURRENT := new LIST; 
THE PATH CURRENT.LOC := NEXT LOC; 
THE PATH CURRENT.NEXT := THE PATH; 
THE PATH := THE PATH CURRENT; 
GOAL := NEXT LOC; 


exit when THE PATH.LOC = START; 
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end loop; 
elsif GOAL FOUND and THE PATH /= null then 
loop 
NEXT LOC := N ARRAY(GOAL(1), GOAL(2), GOAL(3), 
GOAL (4) ) .PARENT; 
new LIST; 
NEXT LOC; 


THE PATH; 


THE PATH CURRENT := 
THE PATH CURRENT.LOC := 
THE PATH CURRENT.NEXT := 


THE FATH = — THE Se AtHeeuRRENT, 
GOAL := NEXT LOC; 
exit when THE PATH.LOC = START; 
end loop; 
else 


put ("PATH NOT FOUND") ; 
new line; 
end if; 
while THE PATH /= null loop 
INT IO.put (PATH FILE, THEE aH. LOC (1) aa, 


INT IO.put (PATH FILE, 
INT IO.put (PATH FILE, 
INT IO.put (PATH FILE, 


THE PATH.LOC(2)); 
THE PATH.LOC(3)); 
THE PATH.LOC(4)); 


new line (PATH FILE); 
THEE ATH i el ieee NE ade, 
end loop; 
put (PATH FILE, "END PATH SEGMENT") ; 
new _line (PATH FILE); 
end P_ PATH; 


procedure F MOVES (N_ARRAY 
ROOT 


in out NODE ARRAY; 
in out LIST PTR) is 


Using the heading of the current node being processed, 
F MOVES determines the legal moves that can be made and 
calls the CHECK ??? procedure in the THE MOVE package: 
HEADING ; INT TYPE := ROOT.LOC (4); 
begin 
case HEADING is 
when 1 => 
CHECK UP_NW (N ARRAY, ROOT); 
CHECK UP_N (N ARRAY, ROOT); 
CHECK UP_NE (N_ ARRAY, ROOT); 
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CHECK NW (N ARRAY, ROOT); 
CHECK N (N ARRAY, ROOT); 
CHECK NE (N ARRAY, ROOT); 
CHECK DOWN_NW (N_ARRAY, ROOT); 
CHECK DOWN _N (N ARRAY, ROOT); 
CHECK _DOWN_NE (N_ARRAY, ROOT); 


when 2 => 
CHECK UP_NE (N ARRAY, ROOT); 
CHECK UP E (N ARRAY, ROOT); 
CHECK UP_SE (N ARRAY, ROOT); 
CHECK NE (N ARRAY, ROOT); 
CHECK E (N_ ARRAY, ROOT); 
CHECK SE (N ARRAY, ROOT); 
CHECK DOWN_NE (N ARRAY, ROOT) ; 
CHECK DOWN E (N ARRAY, ROOT); 
CHECK DOWN_SE (N_ARRAY, ROOT); 


when 3 => 
CHECK UP SE (N ARRAY, ROOT); 
CHECK UP S (N ARRAY, ROOT); 
CHECK UP SW (N ARRAY, ROOT); 
CHECK SE (N ARRAY, ROOT); 
CHECK S (N ARRAY, ROOT); 
CHECK SW (N ARRAY, ROOT); 
CHECK DOWN SE (N ARRAY, ROOT); 
CHECK DOWN S (N ARRAY, ROOT); 
CHECK DOWN SW (N ARRAY, ROOT); 


when 4 => 
CHECK UP SW (N ARRAY, ROOT); 
CHECK UP_W (N ARRAY, ROOT); 
CHECK UP NW (N ARRAY, ROOT); 
CHECK SW (N ARRAY, ROOT); 
CHECK W (N ARRAY, ROOT); 
CHECK NW (N ARRAY, ROOT); 
CHECK DOWN SW (N ARRAY, ROOT); 
CHECK DOWN W (N ARRAY, ROOT }; 
CHECK DOWN NW (N ARRAY, ROOT); 


when others => 
null 
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end case; 
end F MOVES; 


procedure FREE is new UNCHECKED DEALLOCATION (LIST, 
LIST PTR); 


-- Clears old memory space. 
procedure F_ PATH (N ARRAY : in out NODE ARRAY) is 


-- Processes the WAVE list in order calling the F MOVE 
-- procedure. Also reinitializes the WAVE list. 


ROOT selbst Fin]. — Wave, 
begin 


while ROOT /= null loop 
F_ MOVES (N ARRAY, ROOT) ; 


ROOT := WAVE.NEXT; 
FREE (WAVE) ; 
WAVE := ROOT; 

end loop; 


FREE (WAVE) ; 
if GOAL FOUND then 
return; 
end if; 
WAVE := NEW WAVE; 
NEW WAVE := null; 
LAST NEW WAVE := null; 
end F PATH; 


procedure RESET ALL (N ARRAY : in out NODE ARRAY) is 


-- Used to reset™the various attributes in N_ ARRAY changed 
-- during each path segment search. This allows a path to 
-- go to a waypoint/goal and return using many of the nodes 
-- previously used in the outbound trip. 


begin 
GOAL FOUND := FALSE; 
for ROW in 1..MAX ROW loop 
for COL in 1..MAX COL loop 
for DEP in iM e@PBE oor 


fou HPGoin il MAX HDG loop 
N_ ARRAY (ROW, COL, DEP, HDG) . PARENT s= (others => Q); 
N_ ARRAY (ROW, COL, DEP, HDG) .TEND LEN := 0; 
end loop; 
end loop; 
end loop; 
end loop; 
end RESET ALL; 


procedure DO SEARCH is 


-- Calls the major procedures in the search and creates the 
-- N ARRAY. 


N ARRAY : NODE ARRAY (1..MAX ROW, 1..MAX COL, 
1..MAX DEP, 1..MAX HDG); 


begin 
READ TER (N_ ARRAY); 
CREATE (PATH FILE, NAME => “Dabh stile" jes 


loop 
exit when WAVE HEAD.NEXT = null; 
WAVE := new LIST; 
WAVE.LOC := WAVE HEAD.LOC; 
START := WAVE HEAD.LOC; 
GOAL := WAVE HEAD.NEXT.LOC; 


while WAVE /= null and NOT GOAL FOUND loop 
Pore A PHN ARRAY) ; 
end loop; 
P PATH (N_ ARRAY) ; 
RESET ALL (N_ ARRAY); 
WAVE HEAD := WAVE HEAD.NEXT; 
end loop; 
CLOSE (PATH Ff TLE); 
end DO SEARCH; 
end PATHWP; 
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APPENDIX F (part 1) 
Table 1: Data Dictionary for the DIRECTION Search 


PACKAGE 


VARIABLE 


GLOBALS 
DATA_FILE FILE_TYPE 
LOC_ARRAY array (1..4) of INT_TYPE 


LIST record {LOC : LOC_ARRAY 
NEXT : LIST_PTR} 
NEXT : LOC_ARRAY := 


NODE record {STATE : INT_TYPE 
DIST : INT_TYPE :=0 
INC : INT_TYPE := 0 
(9,9,9,9)} 
NODE_ARRAY array (INT_TYPE range <, 
INT_TYPE range <, 
INT_TYPE range <, 
INT_TYPE range <>) of NODE 
TIME 
DURATION 














MAX_ROW INT_TYPE 
MAX_COL 

MAX_DEP 

MAX_HDG 

DIAG_COST := 120 

CARD_COST := 100 


LIST_PTR := null 





CLEAR 


PATH 

START LOC_ARRAY 

GOAL 

GOAL_FOUND BOOLEAN := FALSE 
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Table 1: Data Dictionary for the DIRECTION Search 
PACKAGE 


VARIABLE 


TYPE 


STRING (1..12) 


NAME_LEN INT_TYPE 


P PATH 

P_TAIL LIST_PTR := null 
FIND MOVES 

HDG : ACTIVE_LOC (4) INT_TYPE 


LOC_ARRAY := ACTIVE.LOC 


| NL 
FIND PATH 
F_TAIL | LIST_PTR := null 


DO DIR 

N_ARRAY NODE_ARRAY (1..MAX_ROW, 
1.MAX_COL, 
1..MAX_DEP, 
1..MAX_HDG) 
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DATA FLOW DIAGRAM for the DIRECTION SEARCH (part 2) 
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DIRECTION SEARCH CODE (part 3) 


—--NAME -. Je Bonsignore, Jr. 

--DATE ; 22 Jan, 1991 

——hEV LSED 

=—LITLE >; DIRECTION.ADA 

--DESCRIPTION : Main procedure for the Direction search 
--CALLS ; GET DATA and DO DIR in the B package (like PATH 
ro >: package). 

s-NOTES : 


With TEXT.10, A, B; 
usce 1EXT 10, A,B; 


procedure DIRECTION is 
begin 
GET DATA; 


DO DIR; 
end DIRECTION; 
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cc crc cr cr cr cr ce cc cs cs rc ce cr cs cr cr cr cr cr ce cr cr ce ce ce cs cs cs ce ce ce ce ce es cs cs ce ee ee ee ee es es es ee ee 
cr cr cr crm cr cr cr cr crc cr cr cr ee cc cr cr cr cr cr cr cr cr cr cr ce cr ce ce ce ce ce ee ee es es es es ee ee ee eee ee ee ee ae ae eee Qe Qe Qe ee 


--NAME J. Bonsignore mgt 


--DATE 2 22 Janet oon 

--REVISED 

= — eos >: A.ADS 

--DESCRIPTION : Global variables for the Direction search. 
--CALLS 

=—NO RES 


— em cr ce ce ce ce ce ce ce es ce ce ce ce ce cr re re ee we re re re re cs ee cs ce rc ce ee te ce ee ee ce cs ee es ee ee we es we ee ees ee we oe 
ce ce ce ce ce ce ce ee cr ce: ce: ce ce rr cr cr cr re cr ee er cc cr re ec cs ee es re ee ce ee ee ce es ee ee ee ee ee ee es ee ee ee ee ee ee ee oe 


with TEXT IO, CALENDAR; 
use TEXT IO, CALENDAR; 


package A is 


subtype INT TYPE is INTEGER; 

package INT IO is new INTEGER IO (INT_TYPE); 
package FLOATIO is new FLOAT IO (FLOAT) ; 

use INT IO, FLOATIO; 


type LOC ARRAY is array (1..4) of INT TYPE; 


type List; 
type LIST PTR is access List; 
type LIST is 
record 
LOC : LOC ARRAY; 
NEX? 2s bbotee TR. 
end record; 


ACTIVE: bot le ih 


TAIL. ©: BistePrr. 
CLEAR a) Smee TR 
PATH : LIST PTR; 


type NODE is 


record 
STATE : INT TYPE := 0; 
DIST ; INT TYPE := 0; 
INC : JINETIYEER.. = 0; 
NEXT ; LOG VARRAY = (9,979, 2)); 


end record; 


type NODE ARRAY is array (INT TYPE range <>, INT TYPE range 
<7 ANT Tee range <>," INT TTYEE 
range <>) of NODE; 


20 = Oe io Be) SB | Sag hyd bl 


START TIME :; TIM; 
END_ TIME : TIME; 


T TIME : DURATION; 
MAX ROW : INT TYPE; 


MAX COL : INT TYPE; 
MAX DEP : INT TYPE; 


MAX HDG : INT TYPE := 4; 
DIAG COST : INT TYPE := 120; 
CARD COST : INT TYPE := 100; 


GOAL : LOC ARRAY; 
START : LOC ARRAY; 


end A; 
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--NAME : oJ. Bonsignore, Jr. 


--DATE >; 22 Jan, 1991 
—— hey onl 
=—— Pre iie >: B.ADS 


--DESCRIPTION : This package is similar to the PATH package 
in other programs. 

=< : It contains the major procedures for the 
Direction search. 

—— eS 


with TEXT IO, A, C, UNCHECKED DEALLOCATION, CALENDAR; 
use TEXT IO, A, C, CALENDAR; 


package B is 
procedure DO DIR; 


procedure GET DATA; 


end B; 

--NAME : da Bonsignore, or, 
--DATE 2 22 Jann) 91 
--REVISED 

== eelots >: B.ADB 


--DESCRIPTION : Package body for the B package 


package body B is 

procedure GET DATA is 
~~ Opens the Data file containing terrain information and gets 
-- the array dimensions. It also takes as input the starting 


-- and goal coordinates. 


FILE NAME : STRING (1..12); 
NAME LEN : INT_TYPE; 
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begin 
put ("Enter the name of data file: "); 
get _line (FILE NAME, NAME LEN); 


FILE NAME ((NAME LEN + 1)..12) := (others => ' '); 
Bie, NAME Ce Zhe DAL, 

OPEN (DATA FILE, MODE => IN FILE, NAME => FILE NAME) ; 
INT I1O-get (DATA FILE, MAX ROW) ; 
ENT 1Osget. (DATA FILE, MAX COL); 
INT IO0.get (DATA_FILE, MAX_DEP); 
INT 1TO3g6r (DATA FILE, MAX HDG); 
NEW LINE; 

put ("Enter the starting row: "); 
INT I0.get (START(1)); 

NEW LINE; 

Bue RYEntber ne Starting col: |" ''),; 
INT I0.get (START(2)); 

NEW LINE; 

put ("Enter the starting dep: "); 
INT TO. get. (STARTS) ); 

NEW LINE; 

put, Enter cine starting hdg:) ~")/; 
INT IO0.get (START (4) ); 

NEW LINE; 

put ("Enter the goal row: "); 

INT I10.get (GOAL(1)); 

NEW LINE; 

PUES EMter the goal “coll: “); 

INT I0.get (GOAL(2)); 

NEW LINE; 

put ("Enter the goal dep: "); 

INT IO.get (GOAL(3)); 

NEW LINE; 

put ("Enter the goal hdg: "); 

INT I0.get (GOAL(4)); 

ACTIVE := new LIST; 

ACTIVE.LOC := GOAL; 


end GET DATA; 


procedure READ TER (N ARRAY 
DE ELE 


ve ghaee) ole NODE ARRAY; 
in out FILE TYPE) is 


-- Reads inthe terrain data fromthe file and initializes the 
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-- N ARRAY. 


begin 
for ROW in 1..MAX ROW loop 
for €OL in J..MAX COL esroop 
for DEP in 1..MAX DEP loop 
for HDG in 1..MAX HDG loop 
INT I0.get (D FILE, N_ ARRAY (ROW, COL, 
DEP, 
HDG) .STATE) ; 
end loop; 
end loop; 
end loop; 
end loop; 
Close (DRE TLE): 
end READ TER; 


procedure FREE is new UNCHECKED DEALLOCATION (LIST, 
LIST PTR); 


-- Used to free old memory space. 
procedure FIND MOVES (N ARRAY : in out NODE ARRAY) is 


-- Using the REVERSE heading of the node being processed, 
~- FIND MOVES determines which nodes can legally move into 
-- it. This is OPPOSITE from the other search methods. Again 
-- procedures in the C package (just like THE MOVE) are 

-~- called to process the individual nodes. 


HDG : JUS AE be) & := ACTIVE.LOC (4); 
L : LOC ARRAY := ACTIVE.LOC; 
NL : LOC ARRAY := ACTIVE.LOC; 


begin 
while ACTIVE /= null loop 

HDG := ACTIVE.LOC (4); 

L := ACTIVE.LOC; 

NL := ACTIVE.LOC; 

case HDG is 

when 1 => 

S (L, NL, N_ ARRAY); 
NL := L; 
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US (L, NL, N_ARRAY); 
NL := L; 
DS (L, NL, N_ARRAY); 
NL := L; 


NL(4) := 4; 

SE (L, NL, N ARRAY); 
Ni ..3) 33.1... 3)? 
U_SE (L, NL, N_ARRAY); 
NiO aa3 ise = (il... 3) 
DSE (L, NL, N ARRAY); 
Ning 22s) t= L122 3)? 
NL(4) := 2; 

SW (L, NL, N ARRAY); 
Ninh 3). t= lee oS 
USW (L, NL, N_ ARRAY); 
NL(1..3) := L(1..3); 


DSW (L, NL, N ARRAY); 


when 2 => 
W (L, NL, N ARRAY); 
NL := L; 
UW (L, NL, N_ARRAY); 
NL := L; 
DW (L, NL, N_ ARRAY); 
NL := L; 
NL(4) := 3; 
NW (L, NL, N_ ARRAY); 
NEG. 3). S=eb tle. 3) 
UNW (L, NL, N_ ARRAY); 
NiEGl. 23) =. (1.2.3); 
DNW (L, NL, N_ ARRAY); 
NL := L; 
NL(4) := 1; 
SW (L, NL, N_ ARRAY); 
Ne 3), So ae ess 
USW (L, NL, N ARRAY); 
Nit le 3)s 2 = et ae 8 
DSW (L, NL, N_ ARRAY); 


when 3 => 
N (L, NL, N_ ARRAY); 
NL := L; 
UN (L, NL, N_ ARRAY) ; 
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NL := L; 

DN (L, NL, N_ARRAY); 
NL := L; 

NL(4) := 2; 

NW (L, NL, N_ARRAY) ; 
ND 323). oS Sac): 
UNW (L, NL, N_ARRAY); 


Ni. See elect 
DNW (L, NL, N ARRAY); 
NL := L; 


NL(4) := 4; 

NE (L, NL, N ARRAY); 
NL (1.238) 2S 3G; 2 305 
UNE (L, NL, N ARRAY); 
NEC L242 3)) 2s. 3); 
DNE (L, NL, N ARRAY); 


when 4 => 
E (L, NL, N ARRAY); 
NL := L; 
UE (L, NL, N_ ARRAY); 
NL := L; 
DE (L, NL, N_ARRAY) ; 
NL := L; 
NL(4) := 3; 
NE (L, NL, N_ ARRAY); 
NL.(1 33) 2 = nee 23 )s 
UNE (L, NL, N ARRAY); 
NL (1 323). 49] L338) 
DNE (L, NL, N ARRAY); 
NL := L; 
NL(4) := 1; 
SE (L, NL, N ARRAY); 
NEL... 3 2 = “ele 5) 
U_SE (L, NL, N ARRAY); 
NL (15...3)."2= ti@e...3)> 
DSE (L, NL, N ARRAY); 


when others => 
null; 


end case; 
CLEAR := ACTIVE; 


ACTIVE »= ACTIVE.NEAT; 
CLEAR.NEXT := null; 
FREE (CLEAR) ; 
end loop; 
end FIND MOVES; 


Pprecedure P PATH 1s 


Processes the PATH list for printing. 


EOlArL DIStePER’ 2= FAT, 
begin 

loop 
DUE 0); 
INT IQO.put (ES EATE CCG) )); 
INT Sle. pue (rE TALE. EOC (2) ); 
nvr tO. put (Pu tAtu. LO6(3) )-> 
INT IO.put (P _TAIL.LOC(4)); 
Puc 4°) ); 
NEW LINE; 


exit when P_TAIL.LOC = 
P TAIL.NEXT; 


P TAIL := 
end loop; 
end P_ PATH; 


GOAL; 


procedure FIND PATH (N_ ARRAY 


are traced. 


F TAIL bist Pik; 
begin 

Peat bas= new iio; 

Dg be OGe s—) ore, 

PeIH t= 3F TAIL; 

loop 
exit when F TAIL.LOC = GOAL; 
F TAIL.NEXT := new LIST; 


F TAIL.NEXT.LOC 


Sty o— 


Used to process the PATH list adding nodes as the vectors 
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in out NODE ARRAY) 


:= N_ARRAY(F_TAIL.LOC(1),F_TAIL.LOC(2), 
Ee DATE. LOG(e) 75 TAIL. LOC (4) ):NEXT; 
F TAIL.NEXT; 


end loop; 
end FIND PATH; 


Ppreocedure, DOP IRwis 


-- Creates the N ARRAY dynamically and calls the major 
-- procedures for the search. Some timing constructs are 
-- added for evaluation purposes. 


N ARRAY : NODE ARRAY (1..MAX ROW,1..MAX COL, 
1..MAX DEP,1..MAX HDG); 


begin 
START TIME := CLOCK; 
READ TER (N ARRAY, DATA FILE); 
FIND MOVES (N_ ARRAY); 
FIND PATH (N_ ARRAY) ; 
P PATH; 
END TIME = (Chock, 
T TIME <= END TIMES ote Ese 
FLOATIO.put (FLOAT (T_ TIME) ); 
PUL (" Seconds." )7- 
NEW LINE; 
end DO DIR; 


end B; 
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--NAME - Ws BOnSlonore, “Ur. 

=-DATE © 22 Wan, 1991 

--REVISED : 

=P SUITS IS & : C.ADS 

--DESCRIPTION : The package containing THE MOVE type 
—= > procedures 

==CALLS : 

--NOTES ; Although similar to THE MOVE in other 


programs, the procedures are somewhat 
different due to the "reverse" nature of the 
= ; search. 


ome ee cr cr cr cr cs es ee ee ee a es ee 
<< ee ee ee es ce es ss ee ee es ee ee ee es ee ee ce ce ee ee ee es ee es ee ee es es ee i i 


=e 


with TEXT IO, A 
use TEXT IO, A; 


package C is 


procedure A AND A (L in out LOC ARRAY; 


NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY; 
I : in out INT TYPE); 


procedure N (L : in out LOC ARRAY; 
NL ; Jn Out eEOG ARRAY; 
N ARRAY ¢ in out NODE ARRAY) ; 


procedure NE (L : in out LOC ARRAY; 
NL ; in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY); 


procedure E (L : in out LOC ARRAY; 
NL : ln out LOC_ARRAY; 
N@ARRAY = -1n) Out NODE ARRAY) ; 


procedure SE (L : in out LOC_ARRAY; 
NL amie g aah |b F LOC ARRAY; 
N ARRAY : 5 glaae yeh NODE ARRAY) ; 


procedure S (L >: in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY ; iy Outs NODE ARRAY) ; 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


SW (L 
NL 
N ARRAY 
W (L 
NL : 
N ARRAY : 
NW (L 
NL 
N ARRAY 
UN (L 
NL 
N ARRAY 
UNE (L 
NL 
N ARRAY 
UE (L : 
NL : 
N ARRAY :; 
U_SE (L 
NL 
N ARRAY 
US (L $ 
NL 
N ARRAY : 
USW (L 
NL 
N ARRAY 
UW (L : 
NL : 
N ARRAY 
UNW (L 
NL 


in out LOC ARRAY; 
in out LOC ARRAY; 
in out NODE ARRAY) ; 


in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY); 


in out LOC ARRAY; 
in out LOC ARRAY; 
in out NODE ARRAY); 


in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY); 


in out LOC_ARRAY; 
in out LOC ARRAY; 
> in out NODE ARRAY) ; 


in out LOC_ARRAY; 
in out LOC ARRAY; 
in out NODE ARRAY); 


; in out LOC_ARRAY; 
: in out LOC _ ARRAY; 
> in out NODE ARRAY) ; 


in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY) ; 


in out LOC ARRAY; 
in out LOC ARRAY; 
in out NODE ARRAY) ; 


in out LOC_ARRAY; 
in out LOC_ARRAY; 
in out NODE ARRAY); 


in out LOC ARRAY; 
: in out LOC ARRAY; 
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N ARRAY : in out NODE ARRAY); 


procedure DN (L : in out LOC ARRAY; 
NL vim Out EOC ARRAY; 
N ARRAY : in out NODE ARRAY) ; 


procedure DNE (L in out LOC ARRAY; 
NL in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) ; 


ee ee 


procedure DE (L : in out LOC ARRAY; 
NL : in out LOC_ARRAY; 
N ARRAY : in out NODE_ARRAY) 


=e 


preecedure DSE, (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE_ARRAY); 


procedure DS (L >: in out LOC_ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY); 


procedure DSW (L : in out LOC_ARRAY; 
NL 3 in out LOC ARRAY, 
N ARRAY : in out NODE ARRAY); 


procedure DW (L > in out LOC ARRAY; 
NL : in out LOC_ ARRAY; 
N ARRAY : in out NODE ARRAY); 


procedure DNW (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 


N ARRAY : in out NODE ARRAY) ; 
end C; 
--NAME 7 Je. Bonsignore, Wr. 
-—-DATE 2 22 alan, 2991 
—=REVISED ; 
=—tLTLE $ ‘C2ADS 
--DESCRIPTION : The package body for the C package 
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package body C is 


procedure A AND A (L : in out LOC ARRAY; 
NL in CUE, LOC ARRAY: 
N_ ARRAY > in out NODE ARRAY; 
I > in out INT TYEE) Be 


-- Analyzes and assigns the legal nodes to the ACTIVE list and 
-- sets the various attributes in the N_ ARRAY node. 


begin 
ae N ARRAY (NL(1), NL(2), NL(3), NL(4)).STATE = 0 then 
if N ARRAY (NL(1), NL(2), NL(3), NL(4)).DIST = 0 


then 
if ACTIVE.NEXT = null then 
TAIL := new LIST; 
TAIL.LOC := NL; 
ACTIVE.NEXT := TAIL; 
else 
TAIL.NEXT := new LIST; 
TAIL := TAIL.NEXT; 
TAIL.LOC := NL; 
end if; 
N_ ARRAY (NL(1),NL(2),NL(3),NL(4)) .NEXT := L; 
N_ ARRAY (NL(1),NL(2),NL(3),NL(4)).INC := I; 


N ARRAY (NL (1) ,NL(2),NL(3),NL(4)) .DIST := 
N ARRAY (L(1),L(2),L(3),L(4)) .DIST ap als 
end if; 
end if; 
end A_AND A; 


-- The following procedures all determine the coordinates for 
-- the given move based on the current node coordinates. 
-- Calls” the AGANDRea Procedure. 


procedure N (L : in out LOC_ARRAY; 
NL : in out LOC_ARRAY; 
N ARRAY : in out NODE ARRAY) is 


begin 
if L(1) > 1 then 
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jek (8 aie es 9) Bg 8 se i 
A AND A (L, NL, N_ARRAY, CARD COST); 


end if; 
end N; 
procedure NE (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
if L(1) > 1 and L(2) < MAX COL then 
NEtt)) <= NEC lei; 
NL(2) := NL(2) + 1; 
A AND A (L, NL, N ARRAY, DIAG COST); 
end if; 
end NE; 
Procedure EE. (L 2 an Oue- LOG ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
Tf L(2) < MAX COL then 
NEC2). 2 ="NL (2) +1; 
A AND A (L, NL, N ARRAY, CARD COST); 
end if; 
end E; 
procedure SE (L : in out LOC ARRAY; 
NL >: in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
re (i) =< MAX ROW and L(2) < MAX COL then 
Nit) == NE(1) +51; 
NEC2Z) Ss = NLI(Z) + A: 
A_AND_A (L, NL, N_ ARRAY, DIAG COST); 
end if; 
end SE; 
procedure S (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 


N_ ARRAY : in out NODE ARRAY) is 
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begin 
if L(1) < MAX ROW then 


Ni(1) :=eNL (1). Fea; 
A_AND A (L, NL, N ARRAY, CARD COST); 
end i, 
end S; 
procedure SW (L : in out LOC_ ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
if L(1) < MAX ROW and L(2) > 1 then 
NL(1) := NL(1) + 1; 
NL(2) := NL(2) - 1; 
A_AND A (L, NL, N_ARRAY, DIAG COST); 
ena Gg, 
end SW; 
procedure W (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
Lf (2))e> i then 
NE(Z) >: = NE(2Z) eo 1 
A_AND A (L, NL, N ARRAY, CARD COST); 
sicvel sLié 2 
end W; 
procedure NW (L : in out LOC_ARRAY; 
NL : in out LOC ARRAY; 
N_ ARRAY : in out NODE ARRAY) is 
begin 
if L(1) > 1 and L(2) > 1 then 
NL(1) := NL(1) - 1; 
NLQZ) := NE(Z) =] 
A_AND_A (L, NL, N_ARRAY, DIAG COST); 
end if; 


end NW; 
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procedure UN (L : in out LOC ARRAY; 
NL $ an out LOC ARRAY; 
N ARRAY : en Ole NODE ARRAY) is 


begin 
if wil) > 2 and -b,03) >) 1 then 
NEG) s=— NEC) - 1; 
Nis). 2=.NEt3) =—1; 
A_AND A (L, NL, N_ ARRAY, DIAG COST); 
end if; 
end UN; 
procedure UNE (L In SOUL LOC sARKAY; 
NL - bin OuG LOC ARRAY; 
NOARRAY << in Out NODE ARRAY) is 
begin 
Pe Viel) land (G2) Mae COL and Ub(3 o>) then 
NL(1) := NL(1) - 1; 
NL (2) = NL(2) + 1; 
NiL3).. 2=:NL(3)°—— 1; 
A AND A (L, NL, N ARRAY, DIAG COST); 
end if; 
end UNE; 
procedure UE (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
if L(2) < MAX _COL and L(3) > 1 then 
NL(2) := NL(2) + 1; 
NES) 3= "NEts)- =) 1; 
A_AND_A (L, NL, N_ARRAY, DIAG COST); 
end if; 
end UE; 
Peocedure U.SE. (L : in out LOC ARRAY; 
NL > in out LOC ARRAY; 
N_ ARRAY : in out NODE ARRAY) is 
begin 


if L(1) < MAX ROW and L(2) < MAA COL and b(3) "> «1 
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then 


NL(1) := NL(1) + 1; 
NL(2) := NL(2) + 1; 
NL(3)) := NES) 3= 2 
A AND A (L, NL, N_ ARRAY, DIAG COST); 
end if; 
end U_SE; 
procedure US (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 


N ARRAY : in out NODE ARRAY) is 


begin 
if L(1) < MAX _ROW and L(3) > 1 then 
NL(1) := NL(1) + 1; 
NES). “4—=9NE Cs) 
A AND A (L, NL, N_ARRAY, DIAG COST); 
end if; 
end US; 
procedure USW (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
if L(1) < MAX ROW and L(2) > 1 and L(3) > 1 then 
NL(1) := NL(1) + 1; 
M2) = NL Z) 
NL(3) := NL(3) - 1; 
A_AND A (L, NL, N ARRAY, DIAG COST); 
end if; 
end USW; 
procedure UW (L : in out LOC ARRAY; 
NL > in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
he IG) 2 1, eyptol tn ((3))) ee I eloveio 
NL(2) := NL(2) - 1; 
NL(3) := NL(3) - 1; 
A_AND A (L, NL, N ARRAY, DIAG COST); 
end if; 
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end UW; 


procedure UNW (L ; in out LOC ARRAY; 
NL : in out LOC_ARRAY; 
N ARRAY : in out NODE ARRAY) is 


begin 
ieee el pandel( 2) > 1 ance lb (3)=> 1. then 
Nie) = NE) =: -l; 
Nit2)) 2= NE(Z)- = 1; 
NiE3)7 2= NES) = 2; 
A AND A (L, NL, N_ARRAY, DIAG COST); 
end if; 
end UNW; 
procedure DN (L cpin out LOC ARRAY; 
NL >in) Cut LOC ARRAY, 
N ARRAY : in out NODE ARRAY) is 
begin 
PEE bye ends b( 3) 3 MAX DEE then 
NEG) 2= NEC) >=); 
NES) t= NL(3) -+ 1? 
A AND A (L, NL, N_ ARRAY, DIAG COST); 
end if; 
end DN; 
procedure DNE (L > in out LOC ARRAY; 
NL : in out LOC_ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
if Bbt{l) > land Li2) < MAX COL and-L(3) < MAX DEP 
then 7 7 
Nils. = "NE Gl) => 
Ni(Z t= NE (2) +o 1: 
NaC): S35 Nia ree | 
A_AND A (L, NL, N ARRAY, DIAG COST); 
end if; 7 
end DNE; 
procedure DE (L : in out LOC ARRAY; 
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NL in out LOC ARRAY; 


N ARRAY : in out NODE ARRAY) is 
begin 
if L(2) < MAX COL and L(3) < MAX DEP then 
NL(2) := NL(2) + 1; 
NU(3) c= eNGK 3) eee 
A AND A (L, NL, N_ARRAY, DIAG COST); 
end if; 
end DE; 


procedure DSE (L : in out LOC_ARRAY; 
NL : in out LOC ARRAY; 


N_ ARRAY in out NODE ARRAY) is 
begin 
if L(1) < MAX _ROW and L(2) < MAX COL and L(3) < 
MAX DEP then 
NL(1) := NL(1) + 1; 
NL(2) := NL(2) + 1; 
Ni(3) ¢=_NG(3) Bees: 
A AND A (L, NL, N_ARRAY, DIAG COST); 
end if; 
end DSE; 
procedure DS (L : in out LOC_ARRAY; 
NL : in out LOC_ ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
if L(1) < MAX_ROW and L(3) < MAX DEP then 
NL(1) := NL(1) + 1; 
NL(3) := NL(3) + 1; 
A AND A (L, NL, N ARRAY, DIAG COST); 
end if; 
end DS; 


procedure DSW (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 


begin 
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if L(1) < MAX_ROW and L(2) > 1 and L(3) < MAX DEP 


Een 
Nid); = NEC) 21 
NL(2) := NL(2) - 1; 
Nine So Nis) tel 
POLAND Sr Vie NiGp NSARKAY, DIAG COST); 
end if; 
end DSW; 
procedure DW (L ne OUE LOG ARKAY.; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
if L(2) > 1 and L(3) < MAX _DEP then 
NL(2) := NL(2) - 1; 
NL(3) := NL(3) + 1; 
A_AND_A (L, NL, N_ARRAY, DIAG COST); 
end if; 
end DW; 
procedure DNW (L : in out LOC ARRAY; 
NL : in out LOC ARRAY; 
N ARRAY : in out NODE ARRAY) is 
begin 
Tie drand 12) > 1 and (3) < MAX DEP then 
NL(1) := NL(1) - 1; 
NE(2) 32 = NU(Z)) = 1; 
NL(3) := NL(3) + 1; 
A_AND_A {L, NL, N_ARRAY, DIAG COST); 
end if; 
end DNW; 
end C; 
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APPENDIX G (part 1) 


Table 1: Data Dictionary for the RTA* Search 


STRING (1..12) 


NEXT LOC LOC_ARRAY 

HEADING INT_TYPE := ROOT.LOC (4) 
ASTAR_COST 

LEAST COST 


ROW_COST 
COL_COST 


PACKAGE 
PR D 
VARIABLE 





DEP_COST 
HDG_COST 
NEW_COST 





N_ARRAY NODE_ARRAY (1..MAX_ROW, 


1..MAX_COL,‘ 
1..MAX_DEP, 
1..MAX_HDG) 
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DATA FLOW DIAGRAM for the RTA* SEARCH (part 2) 


_- N_ARRAY 
DO_ 
SEARCH 

oe 


N_ARRAY N_ARRA 


READ > 
TER 


NEW_WAVE 


N_ ARRAY 
WAVE ane 
N f Re Ik A Y 
ROOT 
Nee 
COST 
ROOT 
NAF Gor 
ROOT ROOT 
ow ELE 
NEW_WAVE 
NW 
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REAL-TIME A* SEARCH CODE (part 3) 


iar 


-~-CALLS : GET DATA and DO SEARCH in another PATH 


--NAME : od. BonSignore, 

--DATE - a2 Jane oo 

--REVISED 

== PS Tish : RTA.ADA 

--DESCRIPTION : Main procedure for the RTA* search 
= :package for 

ai >: the RTA. 

==NOTES 


ee a te tw es ww et ee sw we ee 
eee ee ce ee ee ee ce cs ce ce ee ee ee ee ee ce cc ee ec ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ee ae ee ee ee oe 


with TEXT IO, GLOBALS, PATH; 


use TEXT IO, GLOBALS, PATH; 
procedure RTA is 


begin 
GET DATA; 
DO_ SEARCH; 
end RTA; 
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eg ccc mc wr cm re em rr re crm cr rr wc cr cs ec cr co ce ce ce we ee oe ee 
= crc cc crm cg cg cr ce ce cg ce ee ee ee ee eee ee eee eee ee eee eee ee eee eee ee eee eee ee = ee ee ee Gee Gee eer eee GE GE GE GE GE GEE GEE GE Gee = cee cee ce cae 


--NAME so DOnSIGNOLre, pir. 


--DATE See ate oo | 

--REVISED : 

Nest Wd OS >: PATH.ADS 

--DESCRIPTION : Contains the major procedures for the RTA 
ae >: search 

= OF IRIS 

--NOTES 


with TEXT IO, GLOBALS, THE MOVE, UNCHECKED DEALLOCATION; 
use TEXT I0, GLOBALS, THE MOVE; 


package PATH is 
procedure DO SEARCH; 
procedure GET DATA; 
procedure READ TER (N ARRAY : in out NODE ARRAY) ; 


procedure P_ PATH (N_ ARRAY :; in out NODE ARRAY); 


end PATH; 

--NAME 2 wdc Bonsignore, Jr. 

--DATE >: 22 Jan, 1991 

=v LOoBD ; 

aim LE, ; PATH.ADB 

--DESCRIPTION : Package body for the Path package used for 
= >; the RTA search. 


package body PATH is 
procedure GET DATA is 


-- SAME AS OTHER PATH PACKAGE. 
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FILE NAME : STRING (1..12); 
NAME LEN : INT _TYPE; 
begin 
put ("Enter the name of data file: "); 
get line (FILE_NAME, NAME LEN); 
FILE NAME ((NAME_ LEN + 1)..12) := (others => ' '); 
FILE NAME (9..12) := ".DAT"; 


OPEN (DATA FILE, MODE => IN FILE, NAME => FILE NAME); 
INT IO.get (DATA_FILE, MAX_ROW); 
INT IO0.get (DATA FILE, MAX COL); 
INT I0.get (DATA FILE, MAX DEP); 
INT IO.get (DATA FILE, MAX HDG); 


NEW LINE; 

put ("Enter the starting row: "); 
INT I0.get (START (1)); 

NEW LINE; 

put ("Enter the starting col: "); 
INT IO.get (START(2)); 

NEW LINE; 

put ("Enter the starting dep: "); 
INT I0.get (START(3)); 

NEW LINE; 

put ("Enter the starting hdg: "); 
INT IO0.get (START (4)); 

NEW LINE; 

put ("Enter the goal row: "); 

INT I0.get (GOAL(1)); 

NEW LINE; 


put ("Enter the goal col: se... 
INT IO0.get (GOAL(2)); 


NEW LINE; 

put ("Enter the goal dep: "); 
INT I0.get (GOAL(3)); 

NEW LINE; 

put ("Enter the goal hdg: "); 
INT IO0.get (GOAL (4)); 

WAVE := new LIST; 

WAVE.LOC := START; 

WAVE.INC := 0; 


end GET DATA; 


procedure READ TER (N ARRAY : in out NODE ARRAY) is 
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SAME AS OTHER PATH PACKAGE. 


begin 
for ROW in 1..MAX ROW loop 
for, Colin a. MaAx Cor eop 
fOr DEP ano MAX DEP Loop 
for HDG in I..MAX HDG loop 
INT IO0.get (DATA FILE, N ARRAY (ROW, COL, 
DEE, HDG) .ot ATR) ; 


N ARRAY (ROW, COL, DEP, HDG).TEND LEN := 0; 
N ARRAY (ROW, COL, DEP, HDG) .PARENT := 
OOO Cee 
end loop; 


endy loon, 
end loop; 
end loop; 
close (DATA FILE); 
end READ TER; 


procedure P PATH (N ARRAY : in out NODE ARRAY) is 
SAME AS OTHER PATH PACKAGE. 
NEXT LOC : LOC ARRAY; 


begin 
if GOAL FOUND then 

put ('('); 

INT I0.put (GOAL(1)); 

INT IO.put (GOAL(2)); 

INT IO.put (GOAL (3)); 

INT IO.put (GOAL (4)); 

PUGs (7 )." 

new line; 

NEXT LOC := N ARRAY (GOAL(1), GOAL(2), GOAL(3), 

GOAL (4) ) . PARENT; 

while NEXT LOC /= START loop 
PUES 4) 7 
INT TO.put (NEXT LOC(1)); 
INT IO.put (NEXT LOC(2)); 
INT TO. put “ANEXE LOC (3) ); 
INT IO.put (NEXT _LOC(4)); 
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PUER aoe 
NEXT LOC := N ARRAY (NEXT LOC(1), NEXT LOC(2), 
NEXT LOC (3), 
NEXT LOC (4) ) .PARENT; 


NEW LINE; 
end loop; 
put. (ee 


INT, LO put (onan (aya, 
IND lOc pute (SlART (2). 
INT IO.put (START (3)); 
IND OP Duca olLART Aaa. 
put (')'); 
new line; 
INT IO.put (N_ARRAY (GOAL(1), GOAL(2), GOAL(3), 
GOAL (4)).TEND LEN) ; 

new line; 

elise 
put ("PATH NOT FOUND") ; 
new line; 

endef, 

end P_ PATH; 


procedure F MOVES (N_ ARRAY : in out NODE ARRAY; 
ROOT 7 an out, LISTOPTR) as 


-- SAME AS OTHER PATH PACKAGE. 
HEADING : INT TYPE := ROOT.LOC(4); 


begin 
case HEADING is 
when 1 => 
CHECK_UP_NW (N_ARRAY, ROOT); 
CHECK_UP_N (N_ARRAY, ROOT); 
CHECK UP_NE (N_ARRAY, ROOT) ; 
CHECK NW (N_ ARRAY, ROOT) ; 
CHECK N (N ARRAY, ROOT); 
CHECK NE (N ARRAY, ROOT) ; 
CHECK DOWN NW (N_ ARRAY, ROOT) ; 
CHECK DOWN N (N ARRAY, ROOT) ; 
CHECK DOWN_NE (N ARRAY, ROOT) ; 


when 2 => 
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CHECK UP_NE (N ARRAY, ROOT); 
CHECK UP _E (N ARRAY, ROOT); 
CHECK UP_SE (N ARRAY, ROOT); 
CHECK NE (N ARRAY, ROOT); 
CHECK E (N ARRAY, ROOT); 
CHECK SE (N ARRAY, ROOT); 
CHECK DOWN NE (N ARRAY, ROOT); 
CHECK DOWN E (N ARRAY, ROOT); 
CHECK _DOWN_SE (N_ARRAY, ROOT); 


when 3 => 
CHE CKRUE = SE (N_ ARRAY, ROOT); 
CHECK Ue _S (N _ARRAY, ROOT) ; 
CHECKA UES SW (N ARRAY, ROOT); 
CHECK SE (N ARRAY, ROOT); 
CHECK S (N ARRAY, ROOT); 
CHECK SW (N ARRAY, ROOT); 
CHECK_DOWN_SE (N ARRAY, ROOT); 
CHECK DOWN S (N ARRAY, ROOT); 
CHECK DOWN_SW (N_ARRAY, ROOT); 


when 4 => 
CHECK UP_SW (N ARRAY, ROOT); 
CHECK UP_W (N ARRAY, ROOT) ; 
CHECK UP_NW (N ARRAY, ROOT); 
CHECK SW (N ARRAY, ROOT); 
CHECK W (N_ ARRAY, ROOT) ; 
CHECK NW (N ARRAY, ROOT); 
CHECK DOWN SW (N ARRAY, ROOT); 
CHECK DOWN W (N ARRAY, ROOT); 
CHECK DOWN NW (N ARRAY, ROOT) ; 


when others => 
nuli-; 


end case; 
end F_ MOVES; 


procedure FREE is new UNCHECKED DEALLOCATION (LIST, 
LEST PIR); 


-- SAME AS OTHER PATH PACKAGE. 
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procedure F FRONT (N_ ARRAY :; in out NODE ARRAY) is 


This procedure makes two calls to the F MOVES procedure. 
Each call extends the search depth an additional node 
distance. For further frontier nodes subsequent calls to 
F MOVES can be made. 


begin 
F MOVES (N_ ARRAY, WAVE); 
WAVE := NEW WAVE; 
NEW WAVE := null; 


while WAVE /= null loop 
TRASH := WAVE; 
F MOVES (N_ARRAY, WAVE) ; 
WAVE := WAVE.NEXT; 
FREE (TRASH) ; 
end loop; 
end F_FRONT; 


procedure PICK NODE (N ARRAY : in out NODE ARRAY) is 


Estimates the cost to reach the GOAL from the frontier 

nodes and picks the least cost frontier node for further 
expansion. This is currently working in a limited manner. 

Absolute values must be used during the substraction 

of the GOAL from the LOC. 


ASTAR_ COST : INTEGER := 999; 


procedure LEAST COST (LOC yin CUE LEST Ue Thy 
ASTAR COST : in out INTEGER; 
N ARRAY : in NODE ARRAY) is 


Estimates the cost to the GOAL and assigns that nodes 
coordinates to ASTAR_ 
COST if it is less then previously processed nodes cost. 


ROW COST : INTEGER := 0; 
COL COST : INTEGER := 0; 
DEP COST : INTEGER := 0; 
HDG COST : INTEGER := 0; 
NEW COST : INTEGER := 0; 
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begin 


ROW COST := GOAL(1) - LOC.LOC(1); 
EOUNGOST =: — GOAL (2))— LOC, LOG (2) ; 
DEPRGOsi 3— GOAT 3) a= HOG. 80G(4)- 
HDG COST := GOAL(4) - LOC.LOC(4); 
NEW COST := ROW COST + COL COST + DEP COST + HDG COST; 


af + N ARRAY (LOC.LOC(1), LOC.LOC(2), 
-- LOC.LOC(3), LOC.LOC(4)) .TEND LEN; 
if NEW COST < ASTAR_COST then 


ASTAR_COST := NEW COST; 

WAVE := new LIST; 

WAVE.LOC := NEW WAVE.LOC; 
end if; 


end LEAST COST; 


begin 
while NEW WAVE /= null loop 
LEAST COST (NEW WAVE, ASTAR_COST, N_ARRAY); 
al g NEW WAVE.LOC = GOAL then 


GOAL FOUND := TRUE; 
end if; 
exit when GOAL FOUND; 
NEW WAVE := NEW WAVE.NEXT; 
end loop; 


P_NODE (WAVE); 
end PICK NODE; 


procedure DO SEARCH is 


-- Calls the major procedures in the search and creates the 
-- N ARRAY. 


N ARRAY : NODE ARRAY (1..MAX ROW, 1..MAX COL, 
1..MAX DEP, 1..MAX HDG); 


begin 
READ TER (N_ ARRAY) ; 
while not GOAL FOUND loop 
F_ FRONT (N_ARRAY); 
PICK NODE (N_ ARRAY); 
while NEW WAVE /= null loop 
TRASH := NEW WAVE; 
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NEW WAVE := NEW_WAVE.NEXT; 
FREE (TRASH) ; 
end loop; 


NEW WAVE := null; 
end loop; 
GOAL := WAVE.LOC; -- Just for testing purposes! 
GOAL FOUND := TRUE; -- Just for testing purposes! 


P PATH (N ARRAY); 
end DO SEARCH; 


ena FATH, 
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em cc cr cr cr cr mc cc cc ce cr we cs ce we we a 
—_ <= cc cee ee ee ce eee ee ee 


J. Bonsignore, 


--DATE 22 Jan, 199. 
--REVISED 
rt 1 ie 


eaObocRIP TION 


THE MOVE.ADS 


a co cs ce cs ce ce ce ce ce cs ce ce ce ee es ee ee i ee eee ee Ss 
ec cc ce ce ce cc cs ee es es es ce es ee ee ee eee ae ee 


with TEXT IO, GLOBALS; 
use TEXT_IO, GLOBALS; 


package THE MOVE is 


procedure NNC (ELEMENT iP ody YP TR 
HEAD in Out, List EiR; 
TAIL in vout D1St PIR); 
procedure GROW TEND (ELE MeO blo Tar ii, 
N ARRAY : in out NODE ARRAY; 
ROOT POU tals ape i) 
procedure CK STATE (NEW LOC in out LOC ARRAY; 
N ARRAY in out NODE ARRAY; 
NEW_INC Trout. PN She, 
ROOT Inoue LIST PIR); 
procedure CHECK_N (N ARRAY : in out NODE ARRAY; 
ROOT San Out ab hoe barn): 
procedure CHECK_UP_N (N ARRAY in out NODE ARRAY; 
ROOT EEOUt Glo d ye GR) 
procedure CHECK DOWN N- (N ARRAY in out NODE ARRAY; 
ROOT PTL mOuG elo rb PRG, 
procedure CHECK NE (N_ ARRAY in out NODE ARRAY; 
ROOT in-out bist yer): 
procedure CHECK _UP_NE (N ARRAY in out NODE ARRAY; 
ROOT Inoue bot eet): 


Package containing the procedures for 
individual node processing. 


—ooo ec ce ce ce ec cc ce cs cs ce cs cs cs cs cs cs cr ee ee 
ce ce ce ce ce ce ce ce ce cr: ce cc cr cr ce ee ce ce ce ce ee ee ee ee ee ee ee 


121 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


procedure 


CHECK DOWN NE (N ARRAY 
ROOT 


in out NODE ARRAY; 
in out LIST PTR); 


CHECK E (N ARRAY : in out NODE ARRAY; 
ROOT See Hgimepbhe ILS esa) 5 


CHECK UP_E (N_ ARRAY : in out NODE ARRAY; 
ROOT 2 Our abot ee lee 


CHECK DOWN_E (N_ARRAY 
ROOT : 


CHECK SE (N_ARRAY : in 


in out NODE ARRAY; 
in out LIST PTR); 


out NODE ARRAY; 


ROOT : in out LIST PTR); 


CHECK_UP_SE (N ARRAY 


in out NODE ARRAY; 


ROOT : in out LIST PTR); 


CHECK DOWN SE (N_ARRAY 


: in out NODE ARRAY; 


ROOT ; in out LIST wei 


CHECK S (N ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR); 


CHECK _UP_S (N ARRAY : in out NODE ARRAY; 
ROOT Teor so fst ely, 


CHECK DOWN S (N_ ARRAY 
ROOT 


CHECK SW (N ARRAY : in 
ROOT “in 


CHECK UP SW (N ARRAY 
ROOT 


CHECK DOWN SW (N_ ARRAY 
ROOT 


CHECK _W (N ARRAY : in 


: in out NODE ARRAY; 
in Out fist PTR 


out NODE ARRAY; 
out LIST PTR); 


in out NODE ARRAY; 
I OUty ao hae tke, 


in out NODE ARRAY; 
in out HIST EER); 


out NODE ARRAY; 


ROOT : in out LIST PTR); 


CHECK UP _W (N ARRAY 
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in out NODE ARRAY; 


ROOT SU ronb hee OS cy cant 


procedure CHECK DOWN _W (N ARRAY aa Cour NODE ARRAY; 
ROOT ae @ eee 6 He EIST PIR): 


procedure CHECK NW (N_ ARRAY : in out NODE ARRAY; 
ROOT OU Es to PTR), 


procedure CHECK UP NW (N ARRAY : in out NODE ARRAY; 
ROOT See olkigi are} oe IAG ba oo 54) os 


procedure CHECK DOWN NW (N ARRAY : in out NODE ARRAY; 
ROOT eel mOUtwm Ios fb i). 


end THE MOVE; 


--NAME * “sd. -Bonsionoere, Jr. 

=—DATE : 22 van, 1991 

=-KEV LISED : 

Sa ILLES : THE MOVE.ADB 

--DESCRIPTION : Package body for THE MOVE package. 


with TEXT _I0, GLOBALS; 
use TEXT IO, GLOBALS; 


package body THE MOVE is 
procedure NNC (ELEMENT 


HEAD 
TAIL 


in LIST_PTR; 
LG a Ob Nee JeDES IG) as kse 
INOUE abo. Jeet S 


ee ee oe 


-- Creates and maintains lists. 


begin 
if HEAD = null then 
HEAD := ELEMENT; 
TAIL := ELEMENT; 
else 
TAIL.NEXT := ELEMENT; 
TAIL := TAIL.NEXT; 
end if; 
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end NNC; 


procedure GROW TEND (ELE | In OuEr LEST ere 
N_ ARRAY : in out NODE ARRAY; 
ROOT 2 UN SOUG his Toe iEomeic 


-- Expands the search similar to that in the Tendril search. 


procedure ASSIGN (N_ARRAY : in out NODE ARRAY; 
ELE : in out LIST PTR; 
ROOT ; in out LIST PTR) ie 


begin 
if N ARRAY (ELE.LOC(1),ELE.LOC(2),ELE.LOC (3), 
ELE.LOC(4)).TEND LEN = 0 then 
NNC (ELE, NEW WAVE, NW TAIL); 
end if; 
N_ ARRAY (ELE.LOC (1) ,ELE.LOC (2) ,ELE.LOC (3), 
ELE.LOC(4)).PARENT := ROOT.LOC; 
N_ ARRAY (ELE.LOC (1) ,ELE.LOC(2),ELE.LOC (3), 
ELE.LOC(4)).TEND_ LEN := ELE.INC + 
N_ ARRAY (ROOT.LOC (1) , ROOT.LOC (2) , ROOT. LOC (3), 
ROOT.LOC (4) ) . TEND LEN; 
if ELE.LOC = GOAL then 
GOAL FOUND := TRUE; 
end if; 
end ASSIGN; 


begin 
if N ARRAY (ELE.LOC (1) ,ELE.LOC (2) ,ELE.LOC (3), 
ELE.LOC (4)).TEND LEN = 0 then 
ASSIGN (N_ARRAY, ELE, ROOT); 
elsif N_ ARRAY (ELE.LOC(1),ELE.LOC(2),ELE.LOC (3), 
ELE.LOC (4)).TEND LEN > 
(N ARRAY (ROOT.LOC (1) , ROOT.LOC (2) , ROOT. LOC (3), 
ROOT.LOC(4)).TEND LEN + ELE.INC) then 
ASSIGN (N_ARRAY, ELE, ROOT); 
end if; 
end GROW_TEND; 


procedure CK STATE (NEW LOC : in out LOC_ ARRAY; 


N_ ARRAY = In our NODE ARRAY; 
NEW INC ; in Out @NiarYPr, 
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ROOT aero LIST PTR) is 
Similarseo Ch STATE in the Tendril search. 
NEW ELE : LIST PTR; 


begin 
albeit N ARRAY (NEW_LOC (1), NEW LOC (2), NEW LOC(3), 
NEW LOC (4)).STATE = 0 then 
NEW ELE := new LIST; 
NEW ELE.LOC := NEW_LOC; 
NEW ELE.INC := NEW_INC; 
GROW TEND (NEW _ELE, N_ARRAY, ROOT) ; 
end if; 
end CK STATE; 


Following procedures are similar to those in the Tendril 
Searcen!s THEAMOVE 
package. 


procedure CHECK _N (N ARRAY : in out NODE ARRAY; 
ROOT see AC WiG boda eR) ees 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(1) > 1 then 
NEW _LOC(1) := NEW_LOC(1) - 1; 
CK STATE (NEW LOC, N ARRAY, CARD COST, ROOT); 
end if; 
end CHECK N; 


procedure CHECK _UP_N (N_ARRAY : in out NODE ARRAY; 


ROOT Alou ESP aR) ees 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 

TE ONEW LOC (1)-> 1-and NEW LOC(3). > 1 “then 

NEW LOC(1) := NEW LOC(1) - 1; 

NEW _LOC(3) := NEW _LOC(3) - 1; 

Cho SLATE (NEW LOC, N ARRAY, DIAG COs. ROOT): ; 
endif > 
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end CHECK UP_N; 


procedure CHECK _DOWN_N (N ARRAY : in out NODE ARRAY; 
ROOT ;: in oUE LESEEP TR) ©is 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW _LOC(1) > 1 and NEW_LOC(3) < MAX DEP then 
NEW LOC(1) := NEW_LOC(1) - 1; 
NEW_LOC(3) := NEW_LOC(3) + 1; 
CK STATE (NEW_LOC, N_ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK DOWN_N; 


procedure CHECK NE (N ARRAY : in out NODE ARRAY; 
ROOT > in} OUG LEST UPTR) wus 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
if NEW_LOC(1) > 1 and NEW _LOC(2) < MAX COL then 
NEW LOC(1) := NEW_LOC(1) - 1; 
NEW_LOC(2) := NEW_LOC(2) + 1; 
if ROOT.LOC(4) = 1 then 


NEW_LOC (4) := 2; 
else 
NEW LOC(4) := 1; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end. 1: £2 
end CHECK _NE; 
procedure CHECK_UP_NE (N_ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR) is 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_LOC(1) > 1 and NEW _LOC(2) < MAX COL and 
NEW _LOC(3) > 1 then 
NEW _LOC(1) := NEW _LOC(1) - 1; 
NEW_LOC(2) := NEW _LOC(2) + 1; 
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NEW LOC(3) := NEW_LOC(3) - 1; 
if ROOT.LOC(4) = 1 then 
NEW_LOC(4) := 2; 
else 
NEW LOC (4) := 1; 
end if; 
CK STATE (NEW _LOC, N_ARRAY, DIAG COST, ROOT); 
end if; 
end CHECK _UP_NE; 


procedure CHECK DOWN NE (N_ARRAY : in out NODE ARRAY; 
ROOT [Ent OU Lis he DR) es 
NEW LOC : LOC_ARRAY := ROOT.LOC; 
begin 


IF NEW LOC(1) > 1 and NEW_LOC(2) < MAX COL and 
NEW LOC(3) < MAX DEP then 


NEW LOC(1) := NEW_LOC(1) - 1; 
NEW LOC(2) := NEW _LOC(2) + 1; 
NEW _LOC(3) := NEW_LOC(3) + 1; 
if ROOT.LOC(4) = 1 then 
NEW LOC(4) := 2; 
else 
NEW_LOC(4) := 1; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT): 
end if; 


end CHECK DOWN _NE; 


procedure CHECK E (N ARRAY : in out NODE ARRAY; 


ROOT ne OUte ES Pee TR) acs 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 
IF NEW LOC(2Z) < MAX COL then 
NEW LOC(2) := NEW _LOC(2) + 1; 
CK STATE (NEW LOC, N ARRAY, CARD COST, ROOT); 
end if; 


end CHECK. E; 


procedure CHECK _UP_E (N_ARRAY : in out NODE ARRAY; 
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ROOT = in out Blo Der ess 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_ LOC (2) < MAX COL and NEW LOC (3) > 1 then 
NEW LOC(2) := NEW LOC(2) + 1; 
NEW LOC(3) := NEW_LOC(3) - 1; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT) ; 
end if; 


end CHECK UP_E; 


procedure CHECK DOWN E (N ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR) is 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(2) < MAX COL and NEW _LOC(3) < MAX DEP 
then 
NEW LOC(2) := NEW LOC(2) + 1; 
NEW LOC(3) := NEW _LOC(3) + 1; 
Chemo TATE (NEW LOC, N_ ARRAY, DIAG COST, ROOT) ; 
end if; 


end CHECK DOWN E; 


procedure CHECK W (N_ARRAY : in out NODE ARRAY; 
ROOT Se sly eythe EASY JOuUsY) vale 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(2) > 1 then 
NEW LOC(2) := NEW_LOC(2) - 1; 
CK STATE (NEW LOC, N ARRAY, CARD COST, ROOT); 
end if; 


end CHECK W; 


procedure CHECK UP _W (N ARRAY : in out NODE ARRAY; 
ROOT : in out Lis tee ihyes 


NEW LOC : LOC ARRAY := ROOT.LOC; 
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begin 
12 NEW LOC (2) > lt aria, NEW 2bOC (3) °>° 1 then 


NEW LOC(2) := NEW LOC(2) - 1; 

NEW LOC (3) := NEW_ LOC (3) ee 

CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK UP W; 


procedure CHECK DOWN W (N ARRAY : in out NODE ARRAY; 


ROOT : in out LIST PTR) is 
NEW LOC : LOC ARRAY := ROOT. LOC; 
begin 

ie NEW LOC (2) > 1 and NEW_ LOC (3) < MAX DEP then 

NEW LOC(2) := NEW _LOC(2) - 1; 

NEW LOC(3) := NEW_LOC(3) + 1; 

CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK DOWN W; 


procedure CHECK S (N ARRAY : in out NODE ARRAY; 


ROOT one Oler LU Lot ek) ais 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 
IF NEW _LOC(1) < MAX ROW then 
NEW LOC(1) := NEW _LOC(1) + 1; 
CK STATE (NEW LOC, N ARRAY, CARD COST, ROOT); 
end if; 


end CHECK S; 


procedure CHECK UP_S (N_ARRAY : in out NODE ARRAY; 
ROOT ; in out LIST PTR) is 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_LOC(1) < MAX_ROW and NEW LOC(3) > 1 then 
NEW LOC (1) NEW LOC(1) + 1; 
NEW _LOC(3) := NEW _LOC(3) - 1; 
CK_STATE (NEW_LOC, N_ARRAY, DIAG COST, ROOT); 
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end if; 
end CHECK UP S; 


procedure CHECK DOWN_S (N ARRAY : in out NODE ARRAY; 


ROOT : in out LIST PTR) is 
NEW LOC : LOC ARRAY s= ROOT . LOG; 
begin 

IF NEW LOC(1) < MAX_ROW and NEW_LOC(3) < MAX DEP 
then 

NEW LOC(1) := NEW_LOC(1) + 1; 

NEW LOC (3) := NEW_LOC(3) + 1; 

CK STATE (NEW_LOC, N_ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK DOWN S; 


procedure CHECK SE (N ARRAY : in out NODE ARRAY; 


ROOT : in OuG PISieeERy, 1s 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 
IF NEW LOC(1) < MAX ROW and NEW _LOC(2) < MAX COL 
then 
NEW LOC(1) := NEW _LOC(1) + 1; 
NEW LOC(2) := NEW LOC(2) + 1; 
if ROOT.LOC(4) = 2 then 
NEW_LOC(4) := 3; 
else 
NEW LOC(4) := 2; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 
end CHECK SE; 
procedure CHECK_UP_SE (N_ARRAY : in out NODE ARRAY; 
ROOT 3 2M Out LUST ae TR) ees 
NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_LOC(1) < MAX _ROW and NEW _LOC(2) < MAX COL 
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and NEW LOC (3) > 1 then 


NEW LOC(1) := NEW_LOC(1) + 1; 
NEW LOC(2) := NEW_LOC(2) + 1; 
NEW LOC(3) := NEW_LOC(3) - 1; 
if ROOT.LOC(4) = 2 then 
NEW LOC(4) := 3; 
else 
NEW_LOC (4) := 2; 
end if; 
CK STATE (NEW_LOC, N_ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK UP_SE; 


procedure CHECK DOWN SE (N_ ARRAY : in out NODE ARRAY; 
ROOT inn Outs biol bP iijen is 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 


IF NEW LOC(1) < MAX ROW and NEW _LOC(2) < MAX COL 
and NEW LOC(3) < MAX DEP then 


NEW _LOC(1) := NEW _LOC(1) + 1; 
NEW _LOC(2) := NEW LOC(2) + 1; 
NEW LOC (3) := NEW _LOC(3) + 1; 
if ROOT.LOC(4) = 2 then 
NEW LOC (4) := 3; 
else 
NEW LOC (4) := 2; 
engiat - 
CK_STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
‘si q(olestoa, 


end CHECK DOWN SE; 


procedure CHECK SW (N ARRAY : in out NODE ARRAY; 
ROOT ae camo} ie ele TR) is 
NEW LOC : LOC ARRAY := ROOT.LOC; 
begin 


IF NEW _LOC(1) < MAX_ROW and NEW LOC(2) > 1 then 
NEW LOC (1) NEW LOC(1) + 1; 
NEW LOC(2) := NEW LOC(2) - 1; 
if ROOT.LOC(4) = 3 then 
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NEW _ LOC (4) := 4; 
else 
NEW_LOC(4) := 3; 
end af: 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
end if; 
end CHECK SW; 
procedure CHECK _UP_SW (N_ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR) is 


NEW LOC : LOC_ARRAY := ROOT.LOC; 


begin 
IF NEW LOC (1) < MAX ROW and NEW_LOC (2) > 1 and 
NEW LOC(3) > 1 then 


NEW LOC(1) := NEW _LOC(1) + 1; 
NEW LOC(2) := NEW_LOC(2) - 1; 
NEW LOC(3) := NEW_LOC(3) - 1; 
if ROOT.LOC(4) = 3 then 
NEW LOC(4) := 4; 
else 
NEW_LOC(4) := 3; 
end if; 
CK_STATE (NEW LOC, N_ ARRAY, DIAG COST, ROOT); 
enceere- 
end CHECK_UP_SW; 
procedure CHECK DOWN SW (N ARRAY : in out NODE ARRAY; 
ROOT ; In Out LEST PTR) wee 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_LOC(1) < MAX ROW and NEW_LOC(2) > 1 and 
NEW LOC(3) < MAX DEP then 
NEW_LOC(1) := NEW_LOC(1) + 1; 


NEW LOC(2) := NEW _LOC(2) - 1; 
NEW _LOC(3) := NEW_LOC(3) + 1; 
if ROOT.LOC(4) = 3 then 
NEW_LOC (4) := 4; 
else 
NEW LOC(4) := 3; 
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end if; 
Cho er (NEW LOC, N ARRAY, DIAG COST, ROO Ti 
endvi hr, 
end CHECK DOWN SW; 


procedure CHECK NW (N ARRAY = 1 sou e NODE ARRAY; 
ROOT ear Oe. List PIR) 1s 


NEW LOC : LOC_ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(1) > 1 and NEW _LOC(2) > 1 then 
NEW LOC(1) := NEW_LOC(1) - 1; 
NEW LOC(2) := NEW_LOC(2) - 1; 
if ROOT.LOC(4) = 1 then 
NEW LOC (4) := 4; 
else 
NEW LOC (4) := 1; 
endif, 
CK STATE (NEW _LOC, N ARRAY, DIAG COST, ROOT); 
end if; 
end CHECK NW; 
procedure CHECK UP_NW (N ARRAY  : re gigcenshe NODE ARRAY; 
ROOT oAlty Guest hSt or URLs 


NEW LOC : LOC_ARRAY := ROOT.LOC; 


begin 
IF NEW LOC(1) > 1 and NEW_LOC(2) > 1 and 
NEW _LOC(3) > 1 then 


NEW LOC(1) := NEW_LOC(1) - 1; 
NEW LOC(2) := NEW _LOC(2) - 1; 
NEW LOC(3) := NEW LOC(3) - 1; 
if ROOT.LOC(4) = 1 then 
NEW LOC (4) := 4; 
else 
NEW LOC (4) := 1; 
end if; 
CK_STATE (NEW _LOC, N ARRAY, DIAG COST, ROOT); 
end if; 


end CHECK _UP_NW; 
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procedure CHECK DOWN NW (N ARRAY : in out NODE ARRAY; 
ROOT : in out LIST PTR) is 


NEW LOC : LOC ARRAY := ROOT.LOC; 


begin 
IF NEW_LOC(1) > 1 and NEW_LOC(2) > 1 and NEW _LOC(3) 


MAX DEP then 


NEW _LOC(1) := NEW _LOC(1) - 1; 
NEW _LOC(2) := NEW_LOC(2) - 1; 
NEW _LOC(3) := NEW_LOC(3) + 1; 
if ROOT.LOC(4) = 1 then 
NEW _LOC(4) := 4; 
else 
NEW LOC(4) := 1; 
end if; 
CK STATE (NEW LOC, N ARRAY, DIAG COST, ROOT); 
endif > 


end CHECK DOWN NW; 


end THE MOVE; 
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